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Preface 


The integration of GPS and INS allows for more precise position and velocity 
information than is available with either system alone. This thesis investigates the 
possible performance improvement with GPS/INS integration. This research demon¬ 
strates that improvement, and shows attempts to provide verification with empirical 
data. 

The most important tool in this research is the Mutimode Simulation for Op¬ 
timal Filter Evaluation (MSOFE) software package developed by the Avionics Lab¬ 
oratory at Wright-Patterson AFB, OH. This tool was the major resource used to 
verify the truth models, predict filter performance, and implement the filter with 
empirical data. 

I would like to thank Lt Col Lewantowicz for his constant push to obtain 
better results. His help in analyzing the data and results was instrumental to my 
understanding the problems I was facing. I would also like to thank my thesis 
committee members, Dr. Maybeck and Capt Paschall, for their help with Kalman 
filtering concepts and their help in obtaining a better look at the problems being 
encountered. 

The students in the 1989-1990 navigation sequence receive my thanks for forc¬ 
ing me to understand the concepts being used and the many uses to which MSOFE 
can be put. My thanks go out to Capt Britt Snodgrass and Capt Gregory Johnson 
for their help with MSOFE and PROFGEN, and Capt Barbara Niblett for her sup¬ 
port and help in proofreading and other tasks necessary to the completion of this 
document. 

Finally, I would like to thank my family whose constant support throughout 
this effort was essential to its completion. 


James Lawrence Hirning 
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Abstract 

This research develops and attempts to implement a Kalman filter integration 
of a Phase III Global Positioning System (GPS) five-channel receiver and an LN-94 
Inertia! Navigation System (INS). GPS provides highly accurate position and velocity 
information in low dynamic environments. An INS provides position and velocity 
information with lower accuracy over long periods of time, but it is highly responsive 
in dynamic maneuvers or at high frequencies. The INS has the added advantage of 
requiring no signals external to the vehicle to function. The integration of these two 
systems provides more precise information under a wider variety of situations. 

A truth model for the INS is verified. A GPS error model is developed and 
combined with the INS model to provide GPS-aided-INS navigation. This model is 
used to predict baseline performance of a full-ordered filter. Attempts are made to 
utilize the filter with empirical data. The data is analyzed, and suggestions are made 
about ways to account for the errors in evidence. Results to date are presented and 
analyzed. 
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OPTIMAL KALMAN FILTER INTEGRATION OF 
A GLOBAL POSITIONING SYSTEM RECEIVER 
AND AN LN-94 INERTIAL 
NAVIGATION SYSTEM 


I. Introduction 


1.1 Background 

The Global Positioning System (GPS ) is a navigation system which provides 
highly accurate position and velocity estimates to the user (5:144). This system 
consists of three segments: space, control, and user. The space segment consists of 
24 satellites in six orbital planes which receive information from the control segment 
and transmit satellite orbital information to the user segment. The control segment 
monitors satellites and performs updates when necessary. The user equipment re¬ 
ceives signals from at least four different satellites and computes user position and 
velocity which are provided to the user. For GPS to maintain lock on the signals, 
even in a jamming environment, requires that the bandwidth of the receiver be quite 
narrow. However, GPS performance is degraded during high dynamic maneuvers 
due to the narrow bandwidth (6:2). 

An Inertial Navigation System (INS ) provides information about user positio., 
and velocity without external measurements. The INS can provide the same type 
of information as GPS without external signals but with a lesser degree of long 
term accuracy. Also, the vertical channel in the INS is unstable. Errors in the 
INS gyroscopes and accelerometers cause a degradation of the unit’s performance. 
The errors grow slowly with time. As a result, the INS can provide highly accurate 
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position and velocity data for short periods of time. This high frequency response 
allows the INS to continue providing information in highly dynamic environments 
(6:3). 

The integration of these two systems provides many advantages. The first 
of these advantages is to maintain high accuracy position and velocity information 
during all phases of flight. Other potential benefits of this integration include an 
increase in anti-jamming performance of the GPS User Equipment (GPSUE ), aiding 
the reacquisition of satellite signals after interruptions, and an increase in ability 
to track satellites either with adaptive tracking techniques or with steerable beam 
antennas (5:144-145). 

1.2 Research Objective 

The objective of this research is to integrate an LN-94 INS and a GPS receiver 
using a single Kalman filter. A Kalman filter is a computer algorithm which estimates 
the errors in the systems from which it receives measurement inputs. The results of 
this integration are to be used as a truth model baseline from which to compare a 
two-Kalman-filter integration of the LN-94 INS and GPS receiver and reduced order 
filters based on the truth model. The two-filter integration scheme is dicussed in 
Section 1.3. 

1.3 Current GPS/INS Integration Techniques 

Two methods of integrating GPS and INS have been suggested. One proposed 
method uses one Kalman filter internal to the GPSUE and a second Kalman filter 
containing the INS and GPS filtered output (6:1). This configuration is illustrated in 
Figure 1.1 This approach has received much study because of current configuration of 
GPSUE for Air Force aircraft. The second method proposes to integrate the systems 
optimally through the use of a single Kalman filter (5:145). This approach uses the 
raw pseudorange information and is generally accepted a3 the analytically better way 
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Figure 1.1. Two Filter GPS/INS Integration Scheme 


to integrate the two systems. All information shared between equipment onboard 
Air Force aircraft is transmitted over the military standard 1553 digital bus (MIL- 
STD-1553). Phase III GPS receivers are not programmed to provide the necessary 
information (raw pseudorange and delta-range) on the MIL-STD-1553 bus. Hence, 
the necessity to study the first method of integrating INS and GPS equipment. 

1.3.1 Two Filter Implementation Plessey Avionics, and others, have already 
implemented the two-filter configuration (8:117). Plessey Avionics actually used 
three different integrating filters, each for a different dynamic mode of operation. 
They implemented a number of corrections in all of their filters, including a correction 
for the lever arm from the antenna to the GPSUE (8:120-121). The main intent of 
their research was to explore improvement in anti-jamming performance of the GPS 
receiver using INS aiding. Under highly dynamic maneuvers, the position error 
growth was nearly zero even with only two satellites being tracked (8:122 123). 

One major drawback to the two-filter implementation is a degree of instability 
during highly dynamic maneuvers (6:1). This instability is attributed to two ma¬ 
jor sources: the vertical channel instability of the INS and the lack of correlation 
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Figure 1.2. External Single Kalman Filter GPS/INS Integration Scheme 


information between the two systems. The INS hac an inherent vertical channel 
instability and must be aided by altitude information typically provided by a baro¬ 
metric altimeter, but this device does not totally remove the instability. Also, the 
information shared by the two Kalman filters may be highly correlated. With the 
separation of the GPS and INS models, information about this correlation is lost. 
This contributes to the instability of the overall system (6:4). 

1.S.2 Single Filter Implementation Cox discusses an approach for the imple¬ 
mentation of the single filter configuration (5:145-146). This configuration is shown 
in Figure 1.2. Utilizing Cox’s approach, Texas Instruments has implemented a sim¬ 
ilar system using their own GPS receiver and INS (23:1). They also used a lever 
arm correction in their system. Their integration of the two systems provided an 
improvement in the accuracy of position and velocity data. The position error was 
maintained below ten meters and the estimated velocity was within 50 millimeters 
per second of the actual velocity. A test of the receiver was performed to guide 
an aircraft in a terrain following maneuver. The data from this test also showed a 
marked improvement over either GPS or INS alone (23:8). 
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Figure 1.3. Internal Single Kalman Filter GPS/INS Integration Scheme 

A second approach to the single filter configuration was implemented by The 
Charles Stark Draper Laboratory, Inc. utilizing a Rockwell-Collins Phase II GPS 
receiver (22:124). Here, the internal filter of the GPSUE was used to process all 
the information provided by the GPS receiver and the INS. This implementation 
is illustrated in Figure 1.3. The GPSUE filter has very crude approximations in its 
filter models to allow for its use with a number of different INS units. With a Phase II 
receiver, it is possible to change the noise strength models to model a particular INS 
more accurately (22:124). Draper Labs used many different noise strengths to tune 
the filter for their INS. With the proper tuning, the position error was reduced by 29 
percent, and a reduction in velocity error by a factor of five was obtained (22:129). 

The single filter configuration of the GPS and INS integration is attractive but 
is difficult to implement due to current equipment configurations. The GPS does not 
have the ability to output the necessary range and range-rate information onto the 
military standard 1553 (MIL-STD-1553 ) Data Bus. This problem severely limits 
the options available to perform the integration. If the internal filter is to be used, 
it would have to be tuned for each different type of Air Force INS. This problem is 
not insurmountable, but it may be difficult to overcome because of the number of 
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different INS units currently in use. 


1.4 Specific Research Objectives 

This research emphasizes the development and implementation of a single 
Kalman filter method for integrating GPS and INS. Key milestones are develop¬ 
ing and validating the LN-94 truth model, combining the GPS truth model with the 
LN-94 model, developing a Kalman filter for the total system, and implementing 
and validating the Kalman filter on the Sun workstation. Specifics of the research 
objectives are given below. 

1.4-1 LN-94 Truth Model The LN-94 truth model is developed using infor¬ 
mation provided by Litton (14) and is validated using the Multimode Simulation 
for Optimal Filter Evaluation (MSOFE) software developed at the Air Force Wright 
Aeronautical Laboratories (AFWAL) (4). Results of a covariance propagation simu¬ 
lation are compared to the results from a Monte Carlo analysis performed by Litton. 

1-4-9 GPS Truth Model The GPS truth model is added to the LN-94 truth 
model on MSOFE. The GPS model was developed by Capt Joseph I<. Solomon (20). 
This truth model has not been validated against a known standard. Hence, it is 
expected that some tuning will be necessary when this model is used as a filter with 
empirical data. The two truth models are combined, and an MSOFE covariance 
analysis is performed to predict performance of an operational system. 

1-4-3 Kalman Filter Development and Implementation The Kalman filter is 
developed on a VAX 8650, and it is implemented on the same VAX 8650 and on a 
Sun workstation. A GPS receiver and LN-94 INS are optimally integrated using a 
MIL-STD-1553 data bus and an RS-422 port installed on the Sun. The 1553 data 
bus is used primarily for receiving information from the INS. The RS-422 port is 
utilized to obtain data from the GPS receiver. This requires writing software to 
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allow the Sun to collect the data through the RS-422 port. 


I. 4.4 Kalman Filter Validation Validation of the Kalman filter is performed 
by operating the filter on the Sun workstation using empirical data. The results are 
compared to the MSOFG performance prediction. 

1.5 Summary 

A brief discussion is provided about GPS and INS. Different methods of in¬ 
tegration of GPS and INS as implemented by three different groups are described. 
Then, the specific objectives for this research are discussed. 

1.6 Overview 

1.6.1 Chapter 2 Chapter 2 provides the theory necessary to this research. 
Reference frames, coordinate transformations, communication with equipment, and 
Kalman filtering are among the topics presented. 

1 . 6.2 Chapter 3 Chapter 3 discusses the development and verification of the 
truth model used for the INS Kalman filter. The results of two different navigation 
simulations are compared to information provided by Litton Guidance and Control 
Systems. 

1.6.3 Chapter 4 Chapter 4 considers the design of the GPS truth model and 
its integration with the INS truth model. A baseline simulation with which to 
compare filter performance with empirical data is presented. 

1. 6.4 Chapter 5 Chapter 5 delves into empirical data collection and filter op¬ 
eration with empirical data. Problems with filter operation and attempts to correct 
for unexpected errors are presented. 










1,6.5 Chapter 6 Chapter 6 presents conclusions and recommendations. Con¬ 
clusions from the information presented and recommendations for further study are 
discussed. 
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II. Theory 

2.1 Nomenclature Conventions 

Different type styles are used throughout the text to identify scalars, vectors, 
and matrices. Normal and italics text are used for scalar variables (i.e. X n ). Vectors 
are identified with lowercase boldface text (i.e. x). Uppercase boldface is utilized for 
matrices (i.e. C£). A superscript on a boldface character (x n ) normally denotes the 
reference frame in which that variable is expressed. However, a superscript T can 
be used to mean the transpose of a vector or matrix, or the t may refer to the true 
reference frame, described later. To differentiate between these two superscripts, on 
full vectors or matrices, a boldface lowercase superscript (x 4 ) indicates a reference 
frame, and a normal or italics uppercase superscript (x r ) indicates the vector or 
matrix transpose. 

2.2 Reference Frames 

The LN-94 INS works in six different reference frames: earth-centered earth- 
fixed (ECEF ), navigation, true, computer, platform, and body. The GPSUE uses 
two frames of reference: earth-centered earth-fixed and navigation. In order to model 
the two systems properly, it is important to understand the reference frames used. 

2.2.1 Earth-Centered Earth-Fixed Frame The earth-centered earth-fixed 
frame has its origin at the center of the earth. The Litton ECEF frame ( Xi , Yi, 
Zt ) is different from the ECEF frame utilized by GPSUE ( X g , Yj , Z g ). These 
frames are illustrated in Figure 2.1. In the Litton frame, the Yi axis points along 
the earth’s spin axis. Litton’s Z| axis points towards the intersection of the Prime 
(Greenwich) Meridian and the equator. The Xj axis in Litton’s ECEF frame is 
rotated 90 degrees east from the Z| axis along the equatorial piane to complete a 
right-handed coordinate system. The ECEF frame used by GPSUE has its axes 
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Figure 2.1. Litton and GPS ECEF Frames. 


aligned with those of the Litton ECEF frame. However, the GPSUE ECEF frame 
has its X s axis aligned with the Zi axis. The Y, axis is aligned with the Xi axis, and 
the Z, axis is aligned with Litton’s Yi axis. 


2.2.2 Navigation Frame The navigation frames (X„, Y n , Z n ) used by the 
two systems are the same. The axes are oriented to implement the East, North, Up 
frame. In this frame, the X n axis points east, the Y n axis points north, and the Z n 
axis points in the direction of the local vertical. For the GPSUE, the origin of the 
frame is located at the antenna. The origin of the INS’s navigation frame is defined 
within the INS. 


2.2.3 True Frame The true frame (X», V*, Z%) is a wander azimuth reference 
frame. The true frame is rotated counterclockwise about the Z„ axis by a wander 
angle a t which varies with time and aircraft position. When a< = 0, the true frame 
is aligned with the navigation frame. 
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X, 

Figure 2.2. Navigation, True, and Computer Frames. 

2.2.4 Computer Frame The computer frame (X e , Y c , Z e ) is a wander az¬ 
imuth frame also and is the frame which the computer actually implements. The 
computer frame is rotated by an angle of a e about the Z„ axis. When a c = 0, the 
computer frame is aligned with the navigation frame. The computer wander angle, 
a c , differs from a ( because the computer frame is the frame which the INS is actually 
implementing; whereas, the true frame is the frame which the INS is attempting to 
implement. With no errors, the computer and true frames are aligned, and a e is the 
same as ort. The navigation, true, and computer frames are shown in Figure 2.2. 

2.2.5 Platform Frame The platform frame has its origin at the INS and is 
misaligned from the true frame by three small attitude error angles 6<j> y , 6<f> t ). 
When the attitude error angles are all zero, the platform is aligned with the true 
frame. 
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2.2.6 Body Frame The body frame (Xb, Yb, Zb ) has its origin at the aircraft 
center of mass. The Xt, axis is parallel to the fuselage of the aircraft and points 
towards the nose of the aircraft. The Yb axis is parallel to the right wing of the 
aircraft. The Zb axis points through the floor of the aircraft to complete the right 
handed coordinate system. The body frame is illustrated in Figure 2.3. 

2.3 Coordinate Transformations 

Coordinate transformations are required throughout the INS and GPS error 
model. Calculations with vectors require that all the vectors be expressed in the 
same frame. Since not all vectors are expressed in the same frame, it is necessary to 
transform them into a common frame. 

2.8.1 Vector Representations Vectors can be expressed in any of the reference 
frames described earlier. Vector notations used in this text and their associated 
frames are shown below. 

x* Vector in ECEF frame 
x n Vector in navigation frame 
x* Vector in true frame 
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x c Vector in computer frame 
x p Vector in platform frame 
x b Vector in body frame 


2.3.2 Attitude Error Angles The true, computer, and platform frames, im¬ 
plement nearly the same frame. The platform frame, as discussed earlier, is mis¬ 
aligned from the true frame by small attitude error angles ( 8<p x , 8<f> y , 8<f> x ). The 
relationship between these two frames is: 

xP = [I + ^]x 4 (2.1) 

where 

0 8<f> x —8<f> y 

8$ = -8<f> x 0 8<f> x ( 2 . 2 ) 

8<f>y ~~8<f>x 0 

The computer frame is also misaligned from the true frame by small attitude angle 
errors (8 Of, 80 y , 86 x ). The relationship between the computer and true frames is: 

x c = [I-f«0]x t (2.3) 


where 


8 ® = 


0 

- 80 , 

80 y 


8d x 

0 

-60 x 


- 86 v 
80 x 
0 


(2.4) 


2.3.8 Direction Cos i ne Matrices Vectors expressed in the ECEF, navigation, 
true, computer, or body frame can be transformed to a different frame by use of 
direction cosine matrices. These matrices allow transformations of vectors between 
frames which are related to each other through axial rotations. Direction cosine 
matrices (DCMs) are given in the form C„ . The subscript indicates the frame in 





which the vector is given, and the superscript indicates the frame into which the 
vector is transformed. The direction cosine matrices between Litton’s ECEF and 
navigation, navigation and true, and true and body frames are shown below. 


x 1 = C l n x n 


(2.5) 


where 


and 


cos A 

— sin A sin $ 

sin A cos $ 

0 

cos $ 

sin $ 

— sin A 

— cos A sin $ 

cos A cos $ 


A = local terrestrial longitude 
$ = local latitude 


( 2 . 6 ) 


The DGM for the transformation from the true to navigation reference frame is: 


x n = C?x‘ 


(2.7) 


where 



cos a t — sin a t 0 
sin Q ( cos a ( 0 

0 0 1 


( 2 . 8 ) 


The DCM for the true to body frame is obtained from Specification for USAF-15 
Inertial Navigation Set (1) and is presented here: 


= cjy 


(2.9) 
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where 


cos $ cos xp sin t? 

sin <p sin d cos xp — cos <p sin xp — sin p cos t? 

cos p sin t? cos xp + sin p cos xp — cos p cos i? 

( 2 . 10 ) 

and 

p = roll 
1 ? ss pitch 
xp = yaw 

2.4 INS/GPS Integrated Laboratory 

The purpose of the integrated laboratory in the Department of Electrical and 
Computer Engineering at the Air Force Institute of Technology (AFIT) is to allow 
students to test their filter designs using empirical data. The INS is the Litton 
LN-94, and the GPSUE being utilized is the Rockwell-Collins Receiver 3A. 

2 . 4 .I Hardxvare The LN-94 is a strapdown INS. It has three accelerometers 
and three ring laser gyros mounted on the INS platform, which has no motion relative 
to the aircraft except for vibrations transmitted by the vibration isolator mount. A 
gyro and accelerometer along each of the three platform axes measure rotations 
about and accelerations along the respective bodyframe axes, 

The GPS Receiver 3A is a five-channel receiver. Four equations, having the 
three position components and time as unknowns, are used to determine receiver 
position. Solving these equations requires range information from four satellites. 
The satellites transmit signals at two frequencies. The LI frequency is 1575.42 MHz, 
and the L2 frequency is 1227.6 MHz (7:2). Four of the receiver’s channels are used 
to receive and decode LI signals from four separate satellites. The fifth channel may 
do three things. It may receive signals from a fifth satellite, search for other satellites 


Cj> = 


cos 1 ? sin xp 

sin p sin t? sin xp + cos v? cos xp 
cos ip sin t? sin xp — sin <p cos xp 
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to obtain alternative constellations, or receive L2 signals from one of the satellites 
currently being used by the other channels to help estimate the ionospheric delay. 

t. 

8 .4-2 INS En'or Mechanization Equations Terrestrial navigation using iner¬ 
tial sensors involves the measurement of specific forces in three mutually orthogonal 
axes. In the LN-94 this is accomplished by accelerometers mounted in such a way as 
to measure specific force in the body frame. Measurement t from the gyros are used 
by the internal computer to transform the specific force vector to the true frame. The 
gravity force vector is computed using a gravity field model and is removed from the 
measurements, and the measurements are compensated for Coriolis and centripetal 
accelerations. The resulting acceleration vector is integrated with the appropriate 
initial conditions to obtain earth referenced velocity. The nonlinear velocity vector 
differential equation has the form (9:13-1): 

(. 

v = a + c - 7 ( 2 . 11 ) 

where 

a = Measured specific force 
c as Coriolis and centripetal acceleration 
7 = Gravity vector 

The velocity is transformed to the 3CEF frame and is integrated to determine the 
system’s position in terms of latitude ($), longitude (A), wander angle (a t ), and 
altitude (h). The nonlinear equations have the form: 
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( 2 . 12 ) 

(2.13) 

(2.14) 

(2.15) 

The nonlinear Equations (2.11) through (2.15) are combined to form a nonlinear 
vector differential equation. These equations are supplied for analysis purposes only. 
They can be expanded in a Taylor series to determine the error characteristics of the 
system; however, this is not done here. The expansion is performed about a nominal 
point and truncated to first order. The nominal linearization point generally used in 
navigation applications is the INS data corrected by Kalman filter estimated errors. 
The equations for the nominal point are: 


$ 

A 

at 

h 




»P* 

Ui Py sec $> 


wi' - u£ tan $ 


•p* 


ip* 


K n 


$ = + 

(2.16) 

A = Ain, + S), 

(2.17) 

ft = ft.'n. + Sk 

(2.18) 

<*t = a t,n. + Sa t 

(2.19) 


Engineers at Litton augmented the basic error states with error sources specific to 
the LN-94 to create a 93-state truth model. This model is presented in Chapter 3, 
Appendix C, and Litton CDRL No. 1002 (14). 

L. 4.3 GPS Error Mechanization Equations The GPS satellites transmit two 
codes on the LI frequncy: coarse acquisition (OA) and precision (P) codes. The 
coarse acquistion code is utilized by the receiver to obtain lock on the signal. Then, 
the receiver switches to decoding the P-code signal. The P-code is a pseudo-random 
signal which repeats every 267 days (18:6). Each satellite sends a different portion 
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of the code. The receiver determines which satellite has been found by the portion 
of the code being sent. The signal is time tagged by the satellite, and the range to 
the satellite ( R ) is calculated by: 

•R = — c(tge,ieliite ~ ^receiver) (2.20) 


where 


c = vacuum speed of light 


This range is termed the pseudorange because it has not been corrected for errors. 
The main errors in the pseudorange are user clock error, code loop error, and at¬ 
mospheric and ionospheric delay. The error equations used were developed by Capt 
Joseph Solomon in a special study for EENG699 at AFIT (20). The development of 
the error equations is presented later. 


2.5 Equipment Communications 

Operationally, the filter operates with empirical data. This requires communi¬ 
cation with the INS and GPS receiver to obtain the data. Communication with both 
units is accomplished using the MIL-STD-1553 bus. Additional information needed 
for this research is obtained from the receiver through the RS-422 instrumentation 
port. 


2.5.1 MIL-STD-1553 Bus The MIL-STD-1553 bus is the only communica¬ 
tion link between avionics equipment onboard the aircraft. Communication on the 
bus is controlled by a bus controller, which issues commands to each remote terminal 
(RT) to transmit or receive information (12:1-35,1-36). 

The data that an RT may receive or transmit is programmed in the units. Each 
set of data has a subaddress number associated with it that tells the RT what data 
is contained in the set. Because the LN-94 and GPS receiver are both designated as 
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remote terminals, only pre-specified types of information may be obtained by use of 
the MIL-STD-1553 data bus. 

Here, the main use of the MIL-STD-1553 is to obtain information from the INS. 
The information necessary for input to the filter are position, velocity, linear accel¬ 
eration vectors, attitude and attitude rates. This information is directly available 
on the MIL-STD-1553 bus. 

2.5.2 Instrumentation Port In contrast, none of the information necessary 
for the GPS filter is available on the MIL-STD-1553. The only method for obtaining 
the “raw” pseudorange and delta-range data is through the instrumentation port on 
the GPSUE. 

Information available on the instrumentation port has also been predefined in 
data sets called blocks. Operation of the instrumentation port is much like that of 
the MIL-STD-1553, but only two devices can be connected using the required RS-422 
communication protocol. Intermetrics Incorporated has written a software package 
called PC Buffer Box which runs on an IBM PC-AT through which it is possible to 
obtain the information necessary for the filter. 

2.6 Kalman Filter Equations 

A Kalman filter is utilized to estimate the errors committed by the LN-94 and 
GPS Receiver 3A. The error states for the INS are those developed by Litton (14). 
The error states for the GPS receiver were developed by Capt. Solomon, as stated 
previously (20). 

The Kalman filter equations are implemented using a simulation and analy¬ 
sis software package called MSOFE (4) which is discussed later. The form of the 
differential and measurement update equations used by MSOFE are described here. 
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The stochastic differential equations have the form: 

*x(<) = F(t)£x(t) + G(t)w(t) (2.21) 

£{w(t)} = 0 (2.22) 

E{w(t)w T (t + t)} = Q(t)6(r) (2.23) 

where the function E{} is used to mean the expected value of the argument inside 
the braces. The states in the INS truth model are error states. Thus, they are 
referenced in the equations as Sx. The error states are defined as the difference 
between the actual and INS measured states. 

The error state vector Sx and its associated covariance matrix P are propagated 
forward in time between measurements by integrating the equations (16:275): 

&(«|«<-t) = F(t)£x(f|<,\_i) (2.24) 

P(<|(.-.,) = F(()P((|(,-.) + P{(|(,-,)F T (t) + G(t)Q(l)G T (t) (2.25) 

The “hat" (6ffc ) indicates that the quantity is an estimate given by the filter. In 
# # 

addition, the term 6z(t|tj_i) indicates the estimate of Sx at time t given knowledge 
available about 6 x(<|2,_j) through time f,_i. These equations are integrated from 
time to using the initial conditions: 

£x(0) = Sxq (2.26) 

P(0) = P 0 (2.27) 

The INS error states are assumed to be zero mean for lack of a priori information. 
Hence, the vector, Sx o, is a zero vector. The elements of the matrix, Po, are defined 
in Appendix B, and the values of Pq indicate the extent to which the values in 
Sxo are believed to be correct. Updating the state estimates with measurements is 
performed to improve the quality of the state estimates. Measurements have the 
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following form (16:205): 


$*(*•) 

EMU)) 

E{v(li)v T (<i)} 


H(ti)6x(ti) + v((j) 


0 

| R(<i) 


t( — tj 
u f tj 


(2.28) 

(2.29) 

(2.30) 


The measurements are used by the filter to update the state estimates. The mea¬ 
surement update equations are (16:275): 


K(tj) = P(«-)H I '(( i )[H(ii)P(i-)H T (i j ) + R(( i )j-' (2.31) 

fx(tf) = &((-) + K((.) («z(i.) - H(«,)&(!-)] (2.32) 

P((t) = P(l-) - K((,)H(1,)P(|-) (2.33) 


The measurement updates are actually performed using the UD covariance factoriza¬ 
tion update algorithm. This algorithm is discussed by Maybeck (16:392-394). The 
algorithm actually computes the separate factors U and D rather than P , where 
these matrices are interrelated by: 


P = UDU 1 (2.34) 

U is an upper triangular matrix, and D is diagonal. The nth columns of U and D 
are calculated by: 


l?n« — Pnn 

{ 1 isn 

(2.35) 

Pin/Dnn * — Tl — 1, n — 2,... , 1 
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The remaining columns are calculated for j = n - 1, n — 2,..., 1 by: 



Uii 


Pa- ± D kk Uj k 

k*j +1 

[Pii - Efc»i+1 i m j - 1, j - 2,..., 1 

< 1 »ss j (2.36) 

0 * > j 


After U and D have been calculated at time tf, just before measurements are incor¬ 
porated, the update is performed on the matrices. MSOFE performs a scalar update 
for each measurement which occurs. The equations for a scalar update are: 


f = U T (<7)H r (t,) (2.37) 

Vj = Djj(ti)fi j — 1,2, ...,n (2.38) 

a 0 = R (2.39) 


The U and D matrices are updated for k = 1,2,... ,n by: 

** = <**-i + fkVk 

Dkk{t?) ~ Dkk(t~)Qk- j/ofc 

b k — v k (2.40) 

Pk = —fk/dk-l 

For j = 1,2,..., (k — 1), the procedure is continued with: 

UA‘t) = u ik (t-) + i>iPk 

b, - b 3 + U{t - i~)v t (2.41) 


The <— symbol in Equations (2.40) and (2.41) represent the technique in programs 
in which a variable can be overwritten with a different value. The new forms of U 
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and D are then multiplied using (2.34) to form the updated P matrix. The state 
vector is subsequently updated using the following equations. 

K (U) = b/a n (2.42) 

&(<+) - fx(tr+) + K(t i )[z i -H(t i )6x(t')] (2.43) 

This process is repeated for as many scalar measurements as are available at time 
ti. With the completion of the update, the state vector and covariance matrix can 
be propagated to another update time. 

2.6.1 Extended Kalman Filter The Kalman filter equations shown above re¬ 
quire that the dynamics equations be linear. Ohe feature of linear equations is that 
they contain only elements which are taken to the first power. Nonlinear equations 
contain squares, cubes, or greater powers of terms in the equation. An example of a 
linear equation is: 

= x\ + xj (2.44) 

whereas, a nonlinear equation may take the following form: 

x\ - x\ + x\ + z 3 (2.45) 

When some or all of the dynamics equations are non-linear, it becomes necessary to 
either linearize the model or utilize an extended Kalman filter. 

The linearized Kalman filter takes some assumed or known nominal trajectory 
and evaluates the derivatives of the dynamics equations at the nominal trajectory 
to form the dynamics matrix. That is, with a nonlinear set of equations, 

x(<) = f[x(t),u(t),t] (2.46) 
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and some nominal trajectory, x n (<), the linearized dynamics matrix is found by 
(17:41): 


f(«; *.(«)] = af k£ ( ‘ -^ 1 | 


Qy. ix»x„(0 (2.47) 

A nonlinear set of update equations are linearized in a similar fashion (17:41). 


H[<,;x n (t,)] = 


dh[x, *,], 

-|X-Xn(«i) 


(2.48) 


The extended Kalman filter is basically a linearized Kalman filter which relinearizes 
the dynamics equations after each update (17:42), and the update matrix, H , is 
relinearized after each propa^rtK n (17:44). An extended Kalman filter is used in 
this thesis. The nonlinear equations are linearized using a Taylor series expansion 
and truncating to first order. 

For truth model validation, a covariance analysis of the linearized filter as¬ 
sociated with the extended Kalman filter is performed rather than a Monte Carlo 
analysis of the extended Kalman filter. The covariance analysis is used to decrease 
total simulation time to validate the models. The linearization of the extended filter 
is used because that is how MSOFE processes the filter in covariance mode. 


2.7 Software Tools 

As mentioned above, PC Buffer Box (11) is instrumental in obtaining empirical 
data from the GPSUE. Three other programs are also instrumental to the completion 
of the work. The programs are PROFGEN, MSOFE, and MATRIX*. 

2.7.1 PROFGEN PROFGEN is short for PROFile GENerator. This pro¬ 
gram allows for the generation of flight profiles designed by the user. The user is 
able to specify the flight route and maneuvers to be flown, and PROFGEN gen¬ 
erates position, attitude, velocity, and acceleration information for the flight. The 
data output by PROFGEN is usable by MSOFE. More information on PROFGEN is 
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available in ’ PROFGEN - A Computer Program for Generating Flight Profiles ’ (2). 

2.7.2 MSOFE MSOFE stands for Multimode Simulation for Optimal Filter 
Evaluation. This program allows the user to perform Monte Carlo and covariance 
evaluations of Kalman filters. The user programs in the dynamics and update mod¬ 
els. By using internal or external trajectory information, the program allows the 
user to test the designed filter against a truth model. The program can be used to 
validate a truth model, and with small modifications, the user can utilize empirical 
data for measurements. Information on the use of MSOFE is found in the MSOFE 
user’s manual (4). 

2.7.3 MATRIX s MATRIX,, from Integrated Systems, Inc., is a useful tool 
for matrix manipulation, control design and analysis, and plotting. The main use 
to which it is put in this work is plotting. MSOFE is modified to store the required 
outputs in a MATRIX, readable file. Then, the data is loaded into MATRIX, and 
plotted. 

2.8 Summary 

This chapter introduced the reference frames used in the 3tudy, and their rela¬ 
tionships to each other through transformation matrices. Also, a short presentation 
of the INS/GPS Integrated Lab concept and its develoyjment is given. A vital link to 
real world data is through communication with the physical devices. The methods 
in which this was accomplished are presented as well. The last part of the chapter 
deals with the software tools used. The project could not have been performed in a 
timely manner without the aid of the software tools described. 
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III. INS Truth Model Design and Verification 


Litton Guidance and Control Systems developed a 93-state error model for the 
LN-93. This model is applicable to the LN-94 because it is the same INS repackaged 
to fit in the F-15 Eagle fighter aircraft. The error model and the method used to 
verify this particular implementation of the model are discussed here. 

3.1 INS Truth Model 

The states in the INS truth model are interrelated through the system dynam¬ 
ics. The dynamics matrix, F , defines the relation between the system states and 
their derivatives through the following equation. 

$x = F£x + Gw (3.1) 

where w is “white” Gaussian noise. 

3.1.1 States of the Truth Model The state vector used by Litton is parti¬ 
tioned into six subvectors. These subvectors are designated <Sxi, 6 x 3 , ..., Sxq. The 
first subvector, £xi , contains 13 states which are general errors such as position, 
velocity, attitude, and vertical channel errors. The 6 x 3 subvector contains 16 states 
which are the gyro, accelerometer, and barometer time-correlated errors and trends, 
and subvector Sx 5 consists of 18 states related to gyro bias errors. The 6 x 4 sub¬ 
vector consists of 22 states which are related to the accelerometer and barometer 
bias errors. Subvector 6 x 5 contains six states related to the accelerometer and gyro 
initial thermal transients, and the Sxq subvector consists of 18 gyro compliance 
errors. All 93 errors are shown in Table 3.1. The line in column two of Table 3.1 
separates the correlated errors above the line from the trends below. A definition 
for each state can be found in Appendix A. 
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Table 3.1. States in the LN-94 Error Model 
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Litton has supplied \a (one standard deviation) values for latitude and longi¬ 
tude errors and the following states: 8 <j>x , 8 <j> y, 8 <j> z , <$V X , <5V y , <$V Z , and <5/i. Hence, 
outputs of the 1 <t values of these states are necessary to verify that the model has 
been correctly programmed into MSOFE. The 86 { terms represent the errors be¬ 
tween the computer frame and the true frame. These two states can be related to 
the latitude and longitude errors committed by the INS. The 8 <f> { terms are the terms 
of the skew symmetric matrix, described earlier, which relate the computer frame 
orientation to the true frame. The remaining terms of interest are the velocity error 
components in the true frame and the altitude error. 


3.1.2 Truth Model Dynamics Matrix Litton has partitioned the dynamics 
matrix, F, into eight non-zero submatrices which contain all the non-zero elements 
of the dynamics matrix. The dynamics matrix, in terms of the submatrices is: 


F = 


Fu 

0 

0 

0 

0 

0 


F12 
F 22 
0 
0 
0 
0 


F13 
0 
0 
0 
0 
0 


f 14 

0 

0 

0 

0 

0 


F15 
0 
0 
0 
F 55 
0 


F 16 
0 
0 
0 
0 
0 


(3.2) 


The elements of these submatrices are presented in Appendix C. The time-varying 
terms used in the matrix elements are explained here. 

Three different angular velocities which are used in the dynamics matrices are 
defined below. The first is the earth rate in the true frame. 


fi. 


nc/( 2,1) 

fly 

= 

f)C/(2,2) 

fi. 


f)C/(2,3) 
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where ft is the earth sidereal rate, 7.292115x10"® rad/sec. The equation for calcu¬ 
lating the craft rate is: 


“k 


-vjc Ry + n x 

< 

= 

VJC RX +Cl v 

. . 


ft. 


(3-4) 


The V* and V* terms are the x and y velocity components in the true frame. Crx 
and Cry are components of the earth inverse spheroid radii of curvature (14:9). 
They are calculated by: 


Crx = i[l---/{cf(2,3)-2 C,' 1 (2,1)} (3.5) 

a a 

Cry = i[l---/(C/ , (2,3)-2C,‘ 1 (2,2)} (3.6) 

a a 


where a is the equatorial radius of the earth, and f is flattening of the meridional 
ellipse. The third angular velocity is that of the aircraft body with respect to the 
inertial space. This is calculated by: 


“k 


“k 


v? 

“iby 

= 

w k 

+ c[, 

i? 

. . 






(3.7) 


where <p , t? , and tp are the rates of change of roll, pitch, and yaw respectively. This 
angular velocity is transformed to the body frame by: 



where is the matrix inverse of C^. 


(3.8) 
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Specific force values in the true and body frames are terms used in the dynamics 
matrix. The equation relating the two specific force vectors is: 

a<A [ <' 

A[ = Cl Aj (3.9) 

. K \ A* 

In certain elements, an A', term, the specific force in the z axis of the body frame 
with gravity removed, is found. This component is found by: 

A* m C‘( 1,3 )A' X + Ct( 2, Z)A[ + C‘(3,3 )[A\ - G] (3.10) 

where 

G = 50 [1“ (2.00996)- +5.28659x10- 3 {C'(2,3)} 2 ] (3.11) 

CL 

go - 32.08744 ft./sec. 2 (3.12) 

The notation Cl(i,j) indicates the element in row i, column j of the body to true 

frame direction cosine matrix. 

All nine elements of the body-to-true direction cosine matrix are utilized in 
the dynamics matrix. To reduce the space required, the notation for indicating each 
element has been shortened. The element Cl(i, j) is indicated in the matrix as Cy. 

Four vertical channel variables are used in the dynamics matrix. These con¬ 
stants are used as multipliers of states Shi, SS, j, and Sh c in the error model which 
feedback to the vertical velocity and altitude error states. They are calculated by 
the following algorithm (14). 


A = |v;‘l 


(3.13) 
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100(1 + (£-)»] 

Ao 
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Ai 

fyo , 4 
a + A 2 
2 _ 

A? 

A 2 * 


Ag + A 2 


(3.14) 

(3.15) 

(3.16) 

(3.17) 

(3.18) 

(3.19) 


The ten correlated errors in 6 x 2 and the six accelerometer and gyro initial thermal 
transients are all first order Markov processes. Their correlation times are presented 
below. 



= -ft min. - ’ 


= 

\ min ." 1 


= goo sec - _1 


= 

£0 sec - _1 

£/le 

= 5oo seC-—1 


— 

- m . S ec -* 

121522.3 aci " 


The subscripts on the correlation time identifiers refer to the particular state to which 
they correspond (see Appendix A). The bracketed x,y, and z subscripts indicate that 
there is a separate state for each of the three axes. 


The velocity for ‘he gravity error time constant is calculated as: 


|V| = <Jvf+V} + v? 

Many of the values in the dynamics matrix are time varying. Thus, the equations 
presented are programmed into MSOFE as shown so that the dynamics matrix may 
be time varying. 


3-6 







8 .1.8 Model Dynamics Driving Noise As indicated in Equation (3.1), there 
is some “white” Gaussian noise driving the system. Litton partitioned the Gw term 
into two groupings. The form of the noise term is, using the same partitioning as 
seen in Equation (3.2): 

wi 
W2 
0 
0 
0 
0 

It was shown earlier that £{w(t)} = 0 and £{w(t)w r (t + r)} = Q(t)6(r). To be 
consistent with the partitioning of the noise term into two column matrices, the Q 
term is also partitioned into two terms. The form of the matrix used in the model 
is shown below. 

Qn 0 0 0 0 0 

0 Q 22 0 0 0 0 

Q = 0 0 0000 (3.21) 

0 0 0 0 0 0 

0 0 0 0 0 0 

The elements of Qn and Q 22 are shown in Appendix D. The (3 terms which appear 
in the matrices are the same as those defined for the dynamics matrix, as seen on 
the previous page. The cr terms are displayed below. 
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3.2 Truth Model Verification 

After programming the model into MSOFE, the model is verified. During the 
process of verification, a number of discrepancies between the equations and matri¬ 
ces provided in the Litton document were discovered. Also, data on calculations of 
various data and some values of constants were discovered. The discrepancies and 
omissions were resolved with the help of Mr. Lowell Knudsen (13) and Dr. James 
Huddle (10) of Litton Guidance and Control Systems. Errata for the truth model 
document provided by Litton are presented in Appendix F. The Litton document 
provided five types of navigation simulations to form the basis for comparisons. The 
ten-hour static navigation with eight-minute gyrocompass alignment and a two-hour 
fighter navigation with eight-minute gyrocompass alignment are chosen for com¬ 
parison. The static navigation is chosen because of the ease of implementation on 
MSOFE, and the fighter profile is chosen because it provides the greatest observabil¬ 
ity of the error states. 

3.2.1 Gyrocompass Alignment The INS undergoes an eight-minute gyrocom¬ 
pass alignment at the beginning of each simulation. The values used for A, h , V c , 
V v , A*, A y , and A, are 0 deg., 0 ft., 0 fps, 0 fps, 0 fps, 0 ft./sec. 2 , 0 ft./sec. 2 , and 
32.08744 ft./sec. 2 respectively for both flight profiles. The latitude is different for the 
two flight profiles. For the static navigation, the latitude is 32 deg. 46.6 min. North, 
and the latitude is 45 deg. North for the fighter profile. Following the discussion 
in Capt Solomon’s master’s thesis (21:3-9), the alignment is simulated by updating 
the Horizontal plane velocity errors at a rate of 1/2 Hz. The velocity updates, up¬ 
date rate and the measurement noise variances are provided by Litton engineers as 
described in Capt Solomon’s thesis (21:3-9). 

MSOFE requires that the H matrix and measurement noise strength ( R) values 
for each update be entered in the program. MSOFE performs the updates in a 
sequential manner. If two measurements occur at the same time, MSOFE performs 
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an update with one measurement and then performs a another update with the 
second measurement. The H matrices and measurement noise values used for the 
alignment are given below. 

The values for the update of the V velocity error are: 


H = [0 00000100...0] (3.22) 

R = 0.02 ft.Vsec. 2 (3.23) 

The values used for the 'y' velocity error are: 

H = (0 00000010...0] (3.24) 

R = 0.02 ft. a /sec. 3 (3.25) 


The alignment simulation is run for an alignment time of eight minutes. Plots of 
the variances of latitude error, longitude error, and the states 6 <j> x , 6<f> y , 8<ft x , 6V X , 
SV y , and 6 V X are obtained for the covariance analysis simulation and are shown in 
Figure 3.1. 

On the plot of the tilt errors, the north tilt lies on top of the east tilt so that it 
appears that the east tilt error is not displayed. The east tilt error is actually being 
displayed, it is merely hidden by the north tilt error. Some processing of the states 
is performed to obtain output of latitude and longitude errors in feet and to obtain 
the and 8 Vi terms in the navigation frame. Since a covariance analysis is being 
performed, the processing is performed on the covariance matrix. The following 
calculations are used to obtain the latitude and longitude errors in feet: 


P st 


P(l,l) P( 1,2) P(l,3) 
P(2,l) P( 2,2) P( 2,3) 
P(3,l) P(3,2) P(3,3) 


(3.26) 

(3.27) 
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r e * A(1 — e sinZ 2 ) 

r, cos dr -r e sino?r 0 
r e sin dr r e cos dr 0 
0 0 1 

Pli = TliPwTli t 



(3.28) 

(3.29) 

(3.30) 

(3.31) 

(3.32) 


The e term in the calculation of r e , the local distance to earth’s center, is the 
eccentricity of the earth reference ellipse. The equations used for transforming the 
tilts to the navigation frame are: 


P* 


P( 4,4) P(4,5) P(4,6) 
P( 5,4) P(5,5) P(5,6) 
P(6,4) P(6,5) P(6,6) 


Ptut = C?P*C‘ 


(3.33) 

(3.34) 

(3.35) 


where C„ is the transpose and matrix inverse of C“. A similar procedure, shown 
below, is performed for the transformation of the velocity error terms: 


P«v t = 


P(4,4) 
P(5,4) 
P( 6,4) 


P(4,6) ' 
P(5,«) 
P( 6,6) 


P(4,5) 
P(5,5) 
P( 6,5) 


P«Vn = C?P fVt C^ 


(3.36) 

(3.37) 

(3.38) 


The above transformations are used for the plotting of data from the static navigation 
and fighter flight simulations. 


3-11 







8.2.2 Static Navigation Simulation The static simulation is performed with 
a position of 32 deg. 46.6 min. North latitude and 0 deg. longitude. MSOFE 
provides a file at the end of a run which can be used to initialize data at the start of 
another run. The data available at the end of the alignment simulation for 32 deg. 
46.6 min. North latitude is used to initialize the variables at the start of the static 
navigation. 

The variables which are compared to the available Litton information, shown 
for this simulation and the fighter flight in Appendix F, are plotted in Figure 3.2. 
These plots are similar to the plots in the Litton CDRL indicating that the model 
has been correctly implemented. The most significant differences are the size of 
oscillations of the horizontal velocity and tilt errors. The oscillations are not of the 
same magnitude, but the same general trend is evident. Also, the end magnitudes are 
smaller in the covariance simulation than in the Litton document. The differences 
are attributed to performing a covariance analysis while Litton’s plots are the average 
of ten Monte Carlo simulations. 

3.2.3 Fighter Flight Profile Simultion The fighter flight begins at a latitude 
of 45 deg. North. Thus, the initial values of the states and covariance matrix 
are obtained from the output at the end of the 45 deg. North latitude alignment 
simulation. 

The fighter flight is approximated as closely as possible with the information 
given using PROFGEN. The resulting flight is shown in Figure 3.3. The major 
difference between this flight and the Litton profile is that the return flight passes 
the takeoff point so an abrupt turnaround is performed to complete the flight as close 
to the takeoff point as possible. The information shown in the Litton document does 
not show the return flight passing the airfield. However, following the information 
about times, velocities, and altittudes provided, it is impossible to keep from passing 
the point of takeoff. The states of interest are plotted in Figure 3 . 4 . These results are 
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also similar to the plots provided by Litton in Appenix F. The plots show the same 
trends, and the horizontal velocity and tilt errors are nearly the same magnitudes 
as the values shown in the Litton truth model document. This provides additional 
validation of this implementation of the truth model. Differences are primarily the 
result of using covariance analysis instead of Monte Carlo simulations as stated 
earlier. Errors at the end of the flight are the result of the differences in the flight 
profiles at this point. 

3.3 Summary 

The truth model as given in the Litton CDRL is programmed into MSOFE. 
Simulations are performed for an eight-minute alignment, a ten-hour static naviga¬ 
tion, and a two-hour fighter flight. A small amount of post processing is necessary to 
transform the data into the reference system used by Litton. Plots of state variables 
are compared for the static navigation and fighter flight simulations. The plots are 
similar in nature. Differences are the result of different types of simulations being 
performed. Overall, the simulations are quite similar, and the model is judged to be 
correctly implemented. 
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IV. GPS Truth Model Design, Validation and Integration with INS 


The truth model used for the Global Positioning System is based on a model 
developed by Capt Solomon (20). The truth model contains 22 states. Twenty states 
are five states repeated four times, once for each satellite being used to calculate the 
navigation solution. The remaining states pertain to the user clock errors. 

4-1 GPS Truth Model States 

The GPS truth model contains states for the user clock error, code loop error, 
atmospheric error, and satellite position error. A brief discussion of each error is 
given here. The code loop error, atmospheric error, and satellite position errors are 
repeated four times, once for each satellite. User clock errors are the predominant 
errors in the pseudorange and delta-range measurements. Thus, it would seem that 
more states should be used to model the user clock errors than the errors due to 
the satellites. However, the user clock errors are predominantly a bias and a drift. 
Hence, only two states are used to model this error. However, the satellite errors 
are large enough to affect the measurements, and the satellite position errors are 
not easily classified into one or two states. Hence, five states are used to model the 
satellite errors. 

4-1-1 User Clock Error Two states are used to model the user clock error. 
These states model the clock error as a bias and a drift. This model is implemented 
with the following equations. 


Sxb 


0 

1 


Sxb 

Sxd 


0 

0 


Sxd 
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The initial conditions used for these errors are: 

6x(to) — 0 

9xl0 14 ft. 2 0 
0 9xl0 10 fps 2 

No driving noise is included in this model. This could cause the Kalman filter gains 
to go to zero if the same model were used without change as part of the filter design 
model. Hence, it might be necessary to include some pseudonoise in the filter to 
prevent this occurrence. 

4-1.2 Atmospheric Error The atmospheric error is modeled as a first order 
Markov process with a correlation time of 500 seconds (20:7). This model takes into 
consideration not only atmospheric delay, but it also includes ionospheric delays 
which have not been totally removed by the receiver prior to updating with the 
pseudorange and delta-range measurements. The equations used for this model are 
shown below. 

$X a <m(0 = "b U>atm (4.2) 

£{uw(*)} = o 

ft 2 

E{w at m(t)w at m(t + r)} = 0.004 6{t) 

sec. 

The initial conditions for this model are: 

^x a t m {toi) = 0 
P*tm{io) = 1ft. 2 

The correlation time and initial covariance values used by Capt Solomon are based 
on an aircraft flight at an average of 30,000 feet. The laboratory is stationary at 
approximately 1000 feet; therefore, it may be necessary to decrease these values for 
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filter implementation with empirical data because there is more atmosphere between 
the receiver and the satellites. Thus, the atmospheric errors may change at a greater 
rate than is being modeled. The values of Q = 0.004 ft. 2 /sec. and P a <m(*o) = 1 ft. 2 
yield stationary process characteristics. 

Atmospheric delay is not only a function of time but is also a function of 
portion of the sky in which the satellite is located. The signal from a satellite behind 
a cloud will be delayed a different amount than the signal from a satellite with clear 
sky between it and the GPS antenna. Thus, separate atmospheric states are used 
for each satellite because different satellites may be in different portions of the sky. 

4.1.3 Code Loop Error The phase lock loop in the GPSUE has a bandwidth 
of approximately 1 radian per second to maintain signal lock even in a jamming 
environment. Therefore, this error is also modeled with a first order Markov process 
shaping filter. The equations for implementing this model are: 

^Xcode(^) = “ &KcodciX) "h nJ code (4.3) 

£{«We(*)} = 0 

ft. 2 

E{Weode{t)w eo de(t + r)} = 0.5 —^(r) 

sec. 

with initial conditions: 

= 0 

Pcodeito) = 0.25 ft. 2 

The correlation time of this model is one second. The correlation time and the initial 
covariance of 0.25 ft. 2 determines the noise strength of 0.5ft. 2 /sec in order to yield 
stationary process characteristics. 

The five channel receiver in use in this research utilizes a separate correlator 
board for each satellite being used. Hence, a separate code loop is being used for 
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each satellite. Thus, a separate code loop error is modeled for each satellite. 

4.1.4 Satellite Position Error The satellite position error is modeled as a 
three-dimensional random bias vector. Each state models one component of the 
satellite’s position error in the ECEF frame. Some pseudonoise may be necessary 
to portray the time varying nature of this error accurately. The equation used to 
model this error is: 

6xpo t (t) = 0 (4.4) 

with initial conditions: 

dXp<,*(to) = 0 

25 0 0 

P P o,(*o) = 0 25 0 

0 0 25 

4.2 GPS Truth Model Equations 

The equations for the GPS error models are programmed into MSOFE. The 
forms of the dynamics and process noise matrices are presented here. 

4-2.1 GPS Dynamics Matrix The dynamics matrix for the GPS model is 
taken directly from the equations for the error states. The dynamics matrix is 
shown below: 

F c ik 0 0 0 0 

0 F JV j 0 0 0 

F gps =00 F, Iua 0 0 

0 0 0 F, VJ 0 

0 0 0 0 F fV4 
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where 


F elk 


0 1 
0 0 


Fjt,j — 


556 0 0 0 0 

0 -1000 
0 0 0 0 0 

0 0 0 0 0 

0 0 0 0 0 


4-2.2 GPS Process Noise Matrix The process noise matrix Q is broken into 
four parts. The form of this matrix is: 


Q GPS — 


0 0 0 0 0 0 

0 0 0 0 0 0 

0 0 Q JVl 0 0 0 

0 0 0 Q iVa 0 0 

000 0 q,„ 3 0 

000 0 0 q, V4 


(4.6) 


where 


Q/v 


0.004 0 0 0 0 

0 0.5 0 0 0 

0 0 0 0 0 

0 0 0 0 0 

0 0 0 0 0 


ft^ 

sec. 
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4.8 GPS Truth Model Verification 

A one-hour filter run is performed to determine whether or not the equations 
axe entered correctly. The diagonal terms of the covariance matrix are examined to 
determine if the states are behaving as expected. 

The user clock drift and satellite position error variances should remain con¬ 
stant, and the user clock bias should be a line with slope equal to the clock drift. 
The code loop and atmospheric delays are first order Markov processes. With the 
initial variances presented earlier, the variances for these two states should be con¬ 
stant. However, in order to display the transient which occurs with different initial 
variances, the initial variances for the atmospheric and code loop delay states are 
switched. Hence, their variances should approach their final values within their re¬ 
spective correlation times and remain constant thereafter. The plots for the one hour 
simulation of the GPS model are shown in Figure 4.1. The models of atmospheric 
and code loop delays and satellite position errors are the same for all four satellites, 
and this results in identical variances during the analysis. Hence, the results for 
just one satellite are shown. While the models for the satellite states are the same 
for each satellite, the actual values of the errors in the “real” world are different 
for different satellites. Thus, the separation of the five satellite specific errors is 
retained. The user clock errors display the expected results as do the atmospheric 
delay and satellite position errors. The code loop delay appears to be just a straight 
line; however, the code loop correlation time is one second. Thus, the code loop 
delay reached its final value before the first sample was taken at ten seconds into the 
run. Therefore, the models are determined to be programmed correctly. 

4-4 GPS Integration vrith INS 

With the INS model verified against a known standard and the GPS model 
determined to be correctly programmed, the models are combined into a single truth 
model, and they are programmed as a single Kalman filter. The full-ordered filter is 
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to be used as a baseline for order reduction in laboratory experiments; so, no order 
reduction is performed at this point. Hence, the full-ordered filter is being simulated. 

4-4-1 True vs Filter Trajectory Information The trajectory information for 
the verification of the models is uncorrupted by errors (“true” trajectory data). 
This information is either programmed directly into MSOFE, static navigation case, 
or provided by PROFGEN, fighter flight profile case. For the filter performance pre¬ 
diction, the truth model dynamics matrix is calculated with the “true” trajectory 
data. However, the filter is provided corrupted trajectory information. The truth 
model calculations of the INS errors are subtracted from the “true” trajectory to 
obtain information similar to that provided by an actual INS, and the filter esti¬ 
mation of the errors are added to the information to obtain the filter’s estimate of 
the trajectory data. The calculations to provide the filter trajectory data are shown 
below. The wander angle is corrupted by: 


°«m. = a t - Sa t 


where 


8a t = 89, — £Asin$ 


The Kalman filter estimate of the corrupted wander angle is: 


where 


= a U n , + Sat 


A A A 

Sat = 89, — 6Asin$ 


(4-7) 


(4.8) 


(4-f/) 


(4.10) 


4-8 





The estimate of the position vector, ft, is determined by: 


where 


ft = 


$lru« “ 69 + 69 

A 

<^true *“ 6\ + SX 

A 

htrue "" 6H + 6h 


69 « 66 y sin a t — 60 x cos a t 

A A A 

69 as 66 v sin at — 66 x cos a t 
6X = ( 60 v cos at + 66 x sin a t ) sec $ 

A A A A 

6X * ( 66 y cos a t *f 69 x sin a t ) sec $ 
6h = Sh 
6h = 6h 


(4.11) 


(4.12) 

(4.13) 

(4.14) 

(4.15) 

(4.16) 

(4.17) 


The velocity vector is also used in the dynamics matrix. The equation used for 
calculating the velocity vector follows: 


V Xlr „ - SV X + 6V X 
Vy,ru, - SVy + 6V y 
v xtrut - 6V X + 6V X 


(4.18) 


AAA 

where 6V X , 6V yy and SV X are filter states. Since specific force errors are not a part of 
the model, the specific force vector utilized in the filter is obtained from the “true” 
trajectory data. 

4-4-2 GPS Measurement Equations Two types of measurements are used to 
update the filter. These are pseudorange and delta-range information from the 
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(4.19) 


t 


GPSUE. The form of the filter calculated pseudorange (i? e ) equation is (20); 

R' = %/(*„ - &)> + (ft. - Y,i 7 + (21 - Z,) J 
+ SRatm + 6 A/ 

= A + SRclk + SRatm + SR e l (4.20) 


The model for the measured pseudorange (Am) is: 

Rm = y/(x„ - x r y + (Y tv - Y r y + (z. v - z r y + 6 R cth + SR aim + sr cI +» ( 4 . 21 ) 


where v is the measurement noise, and: 


£[v(<,)] = 0 

£[t>(<,) 2 ] = 1026 ft. 2 

= 0 if j 

The value of the measurement noise strength is taken from Martin’s paper on 
GPSUE error models (15:118). The pseudorange calculation provides a measure¬ 
ment equation of the form: 

z = h(x,t) + v (4.22) 

The update equation requires that h(x, t) be linearized about the current best esti¬ 
mate of the states. Expanding the pseudorange calculation in a Taylor series and 
truncating to first order yields: 


R c = Rt + 


X tv — X T c , Y, v — Y r r ,*, , Z sv — Z r 


Rt 


•6X SV -I- 


Rt 


-5Y„ + 


X tv — X T c s, Y, v — Yr C \s Z'V ~ Zr 


-6X r - 


Rt Rt 

+SR c tk + SRatm + SRcl 


-6Y r - 


Rt 


Rt 

SZ T 


SZ a 


(4.23) 
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(4.24) 


« At + UL0S x 6X, v + UL0S y 6Y, v + UL0S,6Z tv 
-ULdSJXr - UCdS y 6Y r - U LOS Mr 
+6Rclk + 6*Ratm + 6Rcl 

The position errors for the receiver, which are shaied with the INS model, are in the 
true frame, and the measured pseudorange is in the ECEF frame. Therefore, the 
position errors must be transformed to the ECEF frame for the calculation of the 
estimated pseudorange. The transformation takes the following form: 

Y r -(R e + h)60 x 

X r =c* t (R s + h)60y (4.25) 

Z r 6h 

where (R e + h) is the local distance to the center of the earth at the current position. 
Note that X r and Y r appear to be interchanged. This accounts for the position error 
states’ rotations about the axis rather than distances. The multiplication by (f? e + /i) 
translates the rotations into distances. This yields an H array, for satellite number 
one, of the form: 

H = [ - ULOSj - ULOSy - ULOSj 0 • • • 0 

10 11 (4.26) 

ULOS x e ULOSy ULOS * 0 • • • 0 ] 

The other three satellite updates would differ from (4.26) in the placement of the 
last two non-zero terms on the second row and three non-zero terms in the last row 
of the equation (composed of twelve terms in all). The elements shown as ULOS, 1 
are meant to include all transformations which take the INS position errors in the 
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true frame to the proper dimensions in the ECEF frame. 

The delta-range (DR) is a measure of the range rate over the past time interval. 
The delta-range is measured by counting the carrier cycles over a period of time 
(15:110). Thus, the delta-range is the change in pseudorange over a particular time 
interval rather than the rate of change of pseudorange. The range rate equation is 
derived by differentiating the true range ( Rt ) equation. This results the equation: 



(X n -X,)(V x „-V x .) (V,. - Y'Wr., - Vy,) 

R R 

(Z av - Z r )\v z „ - V Zr ) 

Ri 


(4.27) 

(4.28) 


This derivation assumes the laboratory is not experiencing roll rates or high g ma¬ 
neuvers. 1'hus, for this specific case, the model for the measured delta-range is 
approximated by the range rate equation: 


DR « R m 

M (X.v-Xr)(Vx„-Vx r ) (Y, v - Y r )(Vy tv - V Yr ) 

Rm Rm 

(Z, v -Zr){Vz, v --Vz r ) 

Rm 


+ &Rclk + V 


( 4 
1 •-*- 


.29) 


(4.30) 


where 


E[v{ti)] = 0 
£[v(f,-) 2 ] = 0.16 ft. 2 
E[v{ti)v(tj)} = 0 i^j 

and SRctk is the user clock drift (the derivative of the user clock bias). Again, 
the measurement noise is obtained from Martin’s paper (15:118). The equation 
for filter calculation of the delta-range is similar to that of the measured delta- 
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A 

range. Substituting R e for Rm and using the Alter estimates of the other values in 
Equation 4.30 yields the filter calculated delta-range. 

Expanding R c in a Taylor series, and truncating to first order yields: 

k c = A t + ^ - v T ^ r)T [I - ULQS r ULQS](6x Jt , - 6x r ) (4.31) 
Rt 

+ULOS(£v,„ — <5v r ) + SR c ik 

The transformation necessary for the pseudorange is also used here to transform the 
position errors into the proper dimensions. A transformation of the velocity errors to 
the ECEF frame is also needed. For the velocity errors, the direction cosine matrix 
to transform vectors in the true frame to the ECEF frame can be used directly. The 
elements of the update matrix H are not shown directly here; however, they can be 
determined from Equation (4.32). 

To provide stability to the stand alone INS solution it is necessary to provide 
barometric altitude measurement updates to the filter. The form for the calculated 
altitude follows: 

h c = hiNS + fih (4.32) 

The measured altitude is computed as the altitude of the navigation laboratory 
(approximately 964 feet). The form for the measured altitude is: 

= ^actual 4" V (4.33) 


where 


EMU)) = 
EMU) 2 } = 
£[u(*,>(<;)] = 
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0 

0.0001 ft. 3 
0 i^j 






This measurement noise may not be correct for an actual altimeter, but it is indica¬ 
tive of the accuracy of the laboratory altitude measurement. The H matrix for this 
update consists of zeros except for the element associated with state xj 0 , 6h. 

4-4-3 Integrated GPS/INS Simulation The truth model is programmed into 
the system portion of MSOFE, and the dynamics noise is programmed to be injected 
into the proper system states. Also, the update equations are programmed into the 
system and filter parts of MSOFE. With this accomplished, a simulation is performed 
to predict the filter performance. 

The simulation consists of an eight-minute alignment followed by thirty minutes 
of static navigation. The filter is updated every ten seconds by both pseu Jorange and 
delta-range measurements during static navigation, and the altitude measurements 
are incorporated every two seconds throughout the simulation. Plots,, ire obtained 
for the measurement residuals, the position and velocity estimation errors, and the 
satellite state estimation errors and are presented in Figures 4.2-4.7. All channels 
exhibit the same behavior characteristics; hence, the satellite state estimation errors 
are shown for one channel. The user clock state estimation errors are not presented 
because they start out with large magnitudes, quickly drop to zero and stay nearly 
zero. In the residual plots, the solid lines are the residuals, and the dashed lines are 
the filter calculated l<r values for the residual. In the estimation error plots, the solid 
lines are the error, and the dashed lines are the estimated ler bounds on the error. 
The estimation errors are the difference between the “true” system values and the 
values for those quantities as estimated by the filter. 

The pseudorange residuals, shown in Figure 4.2, are approximately zero mean 
and stay within a reasonable multiple of the calculated l<r value. Residual monitoring 
was utilized with a bound of 10 <t, and no measurements were discarded. The plots 
display a quantization of the residuals, in that ail residuals are multiples of four 
(e.g. 4, 8, -32). This is attributable to two phenomena: single precision variables 
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Figure 4.2. Pseudorange Residuals 

being used for measurements and residuals being the difference of small numbers. 
The measuremenc values for pseudoranges are sufficiently large that, with single 
precision variables, the precision i3 increased to the units magnitude. Thus, the least 
residual is expected to have a value of one. With the way data is stored in a digital 
computer, as binary numbers, the accuracy of the single precision variables may 
actually be decreased to the point where the least significant bit actually represents 
a magnitude of four. This accounts for the residuals appearing quantized as multiples 
of four. The decision is made to continue in single precision because this does not 
appear to be affecting the simulation in a negative way. 

Delta-range residuals are presented in Figure 4.3. The residuals appear to be 
nearly zero-mean although some plots tend to be slightly biased. They also remain 
within the 10<r bound for residual monitoring. However, the delta-range calculations 
appear to be less accurate than originally anticipated; so, the measurement noise is 
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Figure 4.4. User Position Estimation Errors 
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Figure 4.7. Atmospheric and Satellite Position Estimation Errors 
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increased to 0.5 ft. 2 for the delta-range update. The slight bias being shown in two 
of the plots is likely due to having performed only one Monte Carlo simulation. The 
biases should disappear with more simulations averaged and should be investigated 
later. 

Figure 4.4 presents the user position estimation errors. The longitude error 
remains within 60 feet of zero and shows no particular bias over the whole time 
period. The latitude error takes approximately ten minutes before settling about 
zero error. The altitude error oscillates rapidly about zero as the result of the 
high accuracy altitude updates. The error being displayed is basically reflecting the 
residuals from the altitude updates. Some slight biases over small time intervals may 
be noted in both the latitude and longitude plots. These are again decided to be 
the result of having performed only one simulation. More simulation runs should be 
averaged to determine the correctness of this statement. 

The horizontal velocity errors, shown in Figure 4.5, exhibit a distinct bias. 
The vertical velocity error is zero-mean, and again it reflects the high accuracy used 
for the altitude updates. The biases shown ;n the horizontal velocities could be the 
result of having run only one simulation, it could show something wrong with the 
delta-range updates, or it could show the effect of the high accuracy altitude updates 
pushing vertical errors into the horizontal plane. These are areas for further study. 
At this point, the errors are within expected values for the velocity errors and the 
decision is made to continue. 

The code loop delay is plotted with two separate plots because of the disparity 
in size. The system delay is behaving as a first order Markov process with a one 
second time constant is expected to behave. However, the filter does a very poor 
job of estimating the code loop delay. This indicates a couple of possibilities: the 
state is almost unobservable, the driving noise is too small, or the update rate is 
insufficient for the filter to get a good estimate of this error. Since the driving noise 
is the same for the system and filter, the second possibility is not considered. The 
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other two possibilities are areas for further study. The decision is made to continue 
as the error contributed by the code loop is not so large that compensation can not 
be provided in other states. 

The remaining four states are shown in Figure 4.7. The atmospheric error 
displays a slight bias. This could be the result of the poor code loop delay estimation 
or of having performed only one simulation. The satellite position errors display 
biases in the X[ and Zi directions. A bias may be found in any of the three position 
errors for each channel. This is attributable to using stationary satellites during static 
navigation. Sufficient observability of the satellite position errors is not available 
when utilizing one degree of freedom (i.e., line-of-sight vector to satellite is constant). 
With these small errors, the decision is made to proceed to using empirical data. 

4-5 Summary 

The GPSUE error model is presented and validated. All states behave as 
expected. The GPS model is combined with the INS model, and pseudorange, delta- 
range, and altitude updates are derived. A single Monte Carlo run is performed and 
the results are analyzed. Some small errors are noted. Most of these are attributed 
to having performed a single-sample Monte Carlo simulation. Some minor biases 
are observed but are deemed small enough to justify implementing the filter with 
empirical data. 
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V. Kalman Filter Performance with Empirical Data 


Data collection and interpretation as well as MSOFE modifications are nec¬ 
essary to analyze the performance of the Kalman filter with empirical data. The 
LN-94 is allowed to align for eight minutes before switching to navigation mode and 
collecting the data. Following the INS alignment, data is collected from both the 
GPSUE and the LN-94. 

5.1 Obtaining and Interpreting Data 

The data collection and interpretation requires many steps and the use of two 
computer systems, an IBM PC-AT and a Sun 3 Workstation. The personal computer 
is used to collect data from the GPS receiver through the instrumentation port, and 
the workstation is used to obtain INS information on the MIL-STD-1553 bus. 

5.1.1 GPS Data Collection Data is collected from GPSUE through the in¬ 
strumentation port using PC Buffer Box software on an IBM PC-AT. PC Buffer 
Box consists of two pieces of software, the data collection software (BB.EXE) and 
the post processing software (PP.EXE). Information on this software is found in the 
PC Buffer Box User Manual (11). BB.EXE is menu driven and very user friendly. 
Proceeding through the menu, a Phase III receiver 3A is chosen for the receiver 
type. Using ICD-GPS-215 (3), the decision is made to request block 1022 to obtain 
the pseudorange and delta-range information and blocks 1026 and 1027 for satellite 
position information. The data collection is set to occur for twenty minutes, the file 
to store the data is given a name, and the data collection is started. 

In order for the post processor to interpret the data correctly, a block definition 
file is programmed and given the name BXXXXX.BDF, where XXXXX is a five¬ 
digit number corresponding to the block being processed. The block definition file 
for block 1022 (named B01022.BDF) is shown in Appendix E. The first column is 
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the name given to each piece of data in the block. The second column is the block 
number; it is always 1022 for this block. The third column is the word count within 
the block at which the corresponding data starts. The word length of the data is 
in column four, and column five indicates the data type: R for floating point, I for 
integer, and CF for Collins CAPS floating point. 

Following the data collection and block definition file setup, PP.EXE is exe¬ 
cuted to interpret the information. Selecting printer listings and block 1022 using 
the menus, the GPS time, satellite numbers, measurement type, and measurement 
value are printed to a file for each channel. The four files thus obtained are trans¬ 
ported to the Sun 3 Workstation, and MSOFE is edited to read in the information 
for the performance of measurement updates. 

A similar exercise is repeated to transport the satellite position information to 
the Sun 3 Workstation and edit MSOFE to read the four files containing the satellite 
positions. These files actually contain the line-of-sight vectors to the satellites being 
utilized. Thus, a fifth file is generated to obtain the user position. MSOFE is 
modified to read this file and add the user position vector at each time to the satellite 
line-of-sight vectors to obtain satellite positions. Also, MSOFE is modified to ignore 
any data which is not indicated to be a pseudorange or delta-range measurement. 
This indication is provided in block 1022 and is included in the files containing the 
measurements. The main reasons for this are that the receiver does not provide a 
pseudorange and delta-range update for a channel at any particular time when either 
fewer than four satellites are visible or the channel is changing to receive information 
from a different satellite. 

5.1.2 INS Data Collection Position, velocity, accelerati on, wander angle, 
body attitude, and attitude rates are necessary to calculate the dynamics matrix 
of the filter. The data is obtained from the LN-94 through the MIL-STD 1553 
bus utilizing the Sun 3 Workstation. The BCU/VME-1014 MIL-STD-1553 commu- 
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nications card made by SCI Technology, Incorporated was installed on the Sun 3 
Workstation by Mr. Bruce Clay of Systems Research Laboratory (SRL). Informa¬ 
tion on the software necessary to do this is found in the BCU-VME-1014 Operations 
Manual (19). The software written by Mr. Clay allows the workstation to act as a 
bus controller. In the bus controller mode, the communications card collects all data 
output on the bus in response to commands sent by it. 

To collect the data it is necessary to know the remote terminal number of the 
device, the subaddress numbers which contain the required data, and the number 
of thirty-two bit words in each subaddress. The LN-94 is hard-wired to be remote 
terminal number five. Utilizing FNU-85-1 (1), the decision is made to request sub¬ 
address numbers one and sixteen. Altitude information is supplied to the INS using 
subaddress four. Subaddress one is twenty-two words long, subaddress four is two 
words in length, and the wordlength of subaddress sixteen is thirty-two (1:257,260- 
262). The execution blocks are programmed as specified in the BCU-VME-1014 
Operations Manual to send the altitude information subaddress and request subad¬ 
dresses one and sixteen. A parameter block is set to output the messages at a twenty 
Hertz rate. Mr. Clay’s program is modified to save the requested data every ten 
seconds for twenty minutes. Also, the data is scaled to the proper units, utilizing 
the information in FNU 85-1, before being saved. The INS is initialized to the labo¬ 
ratory’s position and allowed to align for eight minutes. The program to collect the 
data is begun when the INS is set to the navigation mode. 

The program to obtain the data from the LN-94 is written in the C program¬ 
ming language. To utilize the data with MSOFE, the data must be saved in an 
unformatted FORTRAN readable file and in the same order as the data supplied 
by PROFGEN for the fighter flight profile. To this end, a FORTRAN program was 
written which read the formatted data as output by the C program and wrote an 
unformatted file readable by MSOFE. MSOFE is modified so as not to read header 
information from the file FLIGHT since no header information is provided in the 
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empirical INS data. 


5.2 Kalman Filter Evaluation 

With the data collected and interpreted, MSOFE is modified to read the GPS 
measurement and satellite position files, to utilize the data to perform the measure¬ 
ment updates, and to calculate estimates of satellite velocities at the update times. 
An eight-minute alignment of the INS is simulated with no GPS updates, followed 
by filter operation for twenty minutes of GPS pseudorange and delta-range updates 
and altitude updates. 

5.2.1 Filter Operation On the first attempt with empirical data, the filter 
fails to update with all four satellites. The residual monitoring built into MSOFE 
accepts the first channel update and rejects the rest. Subsequently, the residuals for 
all satellites become worse over time. 

As a first attempt to identify the problem, the measurement noise covariance 
in the filter is increased for all measurements. This results in allowing the filter to 
update with all measurements. The residuals are reduced in magnitude but remain 
biased on the order of 10® feet. This indicates that there is some unaccounted error 
which affects each satellite’s measurements individually. 

At this point, the delta-range updates are dropped. The filter can perform 
adequately without the delta-range updates, and some problems experienced in the 
filter simulations point out that incorrect delta-range calculations can seriously de¬ 
grade performance. The delta-range update is thus dropped for the first iteration 
to eliminate a possible source of additional errors. Also, the simulation time is de¬ 
creased to five minutes during which four satellites are used for most of the time 
period. This allows for testing the filter without introducing the increased errors 
when fewer than four satellites are in use. 

Having applied some simple fixes to decrease the modeling error, the true 
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Figure 5.1. Range Drifts Adjusted for Initial Biases 


ranges to the satellites are computed and compared to the pseudorange measure¬ 
ments supplied by the receiver. The true range is subtracted from the pseudorange, 
and the initial biases are subtracted out so that the numbers involved are smaller 
and provide easier analysis results. The results of this comparison are shown in Fig¬ 
ure 5.1. The initial biases for channels one through four are: -77,381,625, -76,523,193, 
-76.090,289, and -76,518,473 feet, respectively. It is seen that there is a large discrep¬ 
ancy among the biases, even to the millions place in one instance. From Figure 5.1, 
it is obvious that the biases do not have the same drift either. The plot for channel 
three also noticably varies in ways which are not attributable to either a bias or a 
drift. 


The errors in evidence in Figure 5.1 are distinctly biases with a drift. The drift 
is apparent from the errors growing in a straight line. However, the biases and drift 
rates are different for each satellite. This suggests a phenomenon which is separate 




























among the satellites. Also, the plots are not perfectly straight lines. Because of the 
scales used in the plots, channel three displays the slight nonlinearity better than the 
other channels. This indicates a varying which may be attributable to atmospheric 
delay. The code loop delay has a one second time constant; thus, it should not be 
causing changes which evidence themselves after twenty seconds or more. Hence, the 
error is attributed to atmospheric delay error. Although there is the possibilty that 
some unmodeled error is causing the variations. The source of this error is a subject 
for further investigation 

The Global Positioning System is currently functioning with selective avail¬ 
ability enabled at unannounced times. Selective availability is a method to degrade 
the accuracy of non-friendly receivers by denying access to the P-code. Selective 
availability results in larger residuals and less accurate position and velocity estima¬ 
tion than in a full availability situation. This causes the filter performance to be 
degraded from the predictions and is an unvalidated source of substantial error. 

The pseudorange and delta-range measurements and the satellite positions 
provided by the GPSUE are output with an associated GPS time. This time tagging 
of the information on the two different busses is provided at one second intervals. It 
is possible that the time tagging of the measurements is performed differently than 
the time tagging of the satellite position data. Also, the satellite positions may have 
been calculated at different times within the one second interval. Time differences 
as small as a millisecond have a significant effect on the value of the pseudorange. 
This is another area for further study. 

The first attempt to correct the error is to add bias and drift states to each 
satellite model. The attempt is suggested from the appearance of the error as a bias 
and drift unique to each satellite and lack of information about any other processes 
which display this characteristic. This effort reduces the residuals with the mea¬ 
surement noise values retained at the values used in the simulation. However, the 
residuals increase slowly with time. 
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The next attempt to correct the problem is to reduce the atmospheric error 
time constant to 100 seconds. The decrease in the time constant is suggested partially 
by the errors displayed in plots of the range errors. Also, the length of time before 
the residuals begin to grow larger appears to be between one and two minutes. The 
results from this attempt are shown in Figure 5.2. The residuals are slightly better 
than in previous attempts; however, the position errors tend to ramp away from 
zero. Also, the residuals still tend to grow with time. Particularly, the residuals in 
channels one and three display a noticable ramp at the beginning of data processing. 

Further attempts to obtain an operational filter are made by varying the at¬ 
mospheric error time constant, the atmospheric error driving noise strength, and the 
measurement noise variance. Results from the best of the attempts are presented 
in Figure 5.3. The atmospheric time constant for this attempt is 50 sec. The mea¬ 
surement noise variance is reduced to 250 ft. 2 , and the driving noise strength is set 
to 0.03 ft. 2 /sec. The residuals remain within a reasonable range around zero for the 
entire time period. With selective availability being used, residuals with magnitudes 
around two hundred feet are not unexpected. However, the latitude and longitude 
errors still ramp away from zero. The error in the position estimation increases at 
a slower rate than with the atmospheric time constant at 100 sec. This is an indi¬ 
cation that the tuning is proceeding in the proper direction; however, the intent is 
to keep the position errors from growing at all. It may be necessary to separate the 
ionspheric delay from the atmospheric delay state. Using different time constants 
for the two phenomena may reduce the growth of the latitude and longitude errors 
even further. It is evident that more work is needed in analyzing the errors in the 
pseudoranges. 

5.3 Summary 

Pseudoranges, delta-ranges, and satellite positions are obtained from the GPS 
receiver through the instumentation port, and MSOFE is modified to utilize the 
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Figure 5.2. Residuals and Position Errors for Atmospheric Time Constant 100 sec. 


5-8 





















Latitude Error (ft) Chan 3 PRonge Residual (ft) Chon 1 PRonge Residual (ft) 


600 


600 



Time (see) 



Time (see) 




436600 437100 437400 437700 

Time (sec) 



Figure 5.3. Residuals and Position Errors for Atmospheric Time Constant 50 sec. 
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alignment. Data is obtained from the GPSUE and INS at the same time. The INS 


data is put in a file in the same form as used by PROFGEN to provide FLIGHT 


files, so MSOFE only needs to be modified to the extent that no header information 


is read from the FLIGHT file. The filter is allowed to perform with real data, and 
errors are noted. The errors are analyzed, and some attempts to correct for the 
errors are made. 
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VI. Conclusions and Recommendations 


All stated research objectives are attempted; most are successful, some require 
additional work. Conclusions drawn from the research and recommendations for 
further research are discussed, 

6.1 Conclusions 

The overall objective stated in the first chapter is to integrate GPS measure¬ 
ments with INS outputs. The first step is to model the two systems and combine 
them in a single Kalman filter. The INS model is obtained from Litton, programmed 
into MSOFE, and validated. With some small anomalies, this is accomplished. The 
anomalies are attributable to having performed a covariance analysis; whereas, the 
basis of comparison is the set of sample statistics obtained by averaging over ten 
Monte Carlo simulations. The INS truth model is determined to be sufficiently cor¬ 
rect. The GPS model is a modified version of that developed by Capt Solomon (20). 
The major difference is the use of a single user clock error rather than separate clock 
errors for the separate satellites. The GPS model is programmed into MSOFE, and 
the states behave as predicted. Thus, the GPS model is deemed to be correct. 

The next step is to combine the two models and predict the performance of 
the joint Kalman filter processing empirical data. A simulation of the full state 
filter running against the truth model is performed to this end. The residuals from 
the pseudorange and delta-range updates remain within expected bounds, and the 
position and velocity errors also remain relatively close to zero. Thus, the filter is 
determined to be correctly implemented. Inability of the GPS model to obtain good 
estimation of the code loop error indicates that this state may be a candidate for 
removal when filter reduction is performed in later research. The estimation errors 
in the satellite position errors indicate a possibility to condense the three satellite 


position states into one state along the current line-of-sight when filter reduction is 
performed. 

The final step is to process empirical data through the filter. This step is 
not completely accomplished. The data is obtained to operate the filter, but filter 
performance is well below that which is predicted. Analysis of the data indicates 
that the filter could possibly be tus ed more carefully to alleviate the problem, or 
that the GPS model may need to be changed to account for the errors observed. 
Some small changes are made to the filter which clean up the residuals reasonably, 
but the position errors remain unacceptable. 

6.2 Recommendations 

Some ideas for further research are presented below. These areas will provide 
useful information with which to obtain better filter performance with the empirical 
data. 


6.2.1 Discover and Fix Problem with Pseudoranges It is possible that the 
ranges compared with the pseudoranges are being incorrectly calculated. If this 
is the case, discovering this problem and fixing it should clear up most of the errors 
being experienced. 

6.2.2 Further Analyze the Discrepancies in the Data Other errors are in evi¬ 
dence than just the large bias problem. Analysis and resolution of these discrepancies 
will serve to improve filter performance further. 

6.2.3 Tune the Filter Tuning the filter using the empirical data (corrected 
for errors if necessary) will provide improved filter performance. The closer the filter 
is to modeling the “real” world, the better the filter performance will be. 
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6.2.4 Reevaluate the GPS Error Model A reevaluation of the GPS error 
model to determine correctness will be useful. If the model is significantly differ¬ 
ent from what is actually occurring, filter performance will be degraded. This is a 
possible explanation for some of the problems encountered here. 

6.2.5 Check Data Time Tagging If time tagging of the pseudorange and 
delta-range information is performed differently from the time tagging of the satel¬ 
lite positions, a significant error could result from even a difference in time as small 
as a millisecond. Closer examination of how the time tagging of the information is 
performed may reduce some of the errors evident here. 

6.2.6 More Filter Simulations One Monte Carlo anaylsis was performed in 
the combined model prediction. Performing more Monte Carlo runs to validate the 
analysis in Chapter 4 may yield more insight to the problems encountered. 

6.2.7 Horizontal Velocity Errors The horizontal velocity error biases 
displayed in the filter performance prediction need to be studied. The delta-range 
and altitude updates are possible sources for this error as stated in Chpater 4. Re¬ 
moving these biases may improve filter performance. 

6.2.8 Code Loop Estimation The filter does a very poor job of estimating the 
code loop error. Further investigation as to the cause of this poor estimation should 
be considered. Possible sources for this problem are that the code loop delay state 
is unobservable, and that the driving noise strength on this state is too small. 

6.2.9 Satellite Position Error s The filter also does a poor job of estimating 
the satellite position errors during performance prediction. This is attributed to 
both the satellites and the GPS unit being stationary during the simulation. More 
work needs to be done to verify that this is the case. Simulating either satellite or 
aircraft movement will verify whether or not this is true. 
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Appendix A. INS Truth Model State Definitions 


The truth model is composed of 93 states that are all errors committed by 
the LN-94. The state number used in MSOFE, the state symbol as used in the 
Litton CDRL (14), and a short definition of each state are given here. The states 
are shown in tables which are broken into the state subvectors defined previously. 
(Note: The state symbol here, 6 fa , is given by Litton as fa. The change here is 
to remove confusion between all the terms which are symbolized by 4> in the Litton 
CDRL.) 


Table A.l. Definition of INS Truth Model Subvector 


State 

Number 

E353SI 

Definition 

1 

ee x 

X-component of vector angle from true to computer frame 

2 

wwm 

Y-component of vector angle from true to computer frame 

3 

66 , 

Z-component of vector angle from true to computer frame 

4 

mm 

X-component of vector angle from true to platform frame 

5 

54>y 

Y-component of vector angle from true to platform frame 

6 

6 fa 

Z-component of vector angle from true to platform frame 

7 

6 V t 

X-component of error in computed velocity 

8 

mm 

Y-component of error in computed velocity 

9 

6 V X 

Z-component of error in computed velocity 

10 

6 h 

Error in vehicle altitude above reference ellipsiod 

11 

6 h L 

Error in lagged inertial altitude 

12 


Error in vertical channel aiding state 

13 

6 S 4 

Error in vertical channel aiding state 
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Table A.2. Definition of INS Truth Model Subvector 6 x 2 


State 

Number 

State 

Symbol 

Definition 

14 

K 

X-component of gyro correlated drift rate 

15 

K 

Y-cornponent of gyro correlated drift rate 

16 


Z-component of gyro correlated drift rate 

17 

m 

X-component of accelerometer and 
velocity quantizer correlated noise 

18 

m 

Y-component of accelerometer and 
velocity quantizer correlated noise 

19 

v ie 

Z-component of accelerometer and 
velocity quantizer correlated noise 

20 

f>9r 

X-component of gravity vector errors 

21 


Y-component of gravity vector errors 

22 

Sg x 

Z-component of gravity vector errors 

23 

mm 

Barometer correlated bias noise error 

24 

K 

X-component of gyro trend 

25 

by, 

Y-component of gyro trend 

26 

K 

Z-component of gyro trend 

27 


X-component of accelerometer trend 

28 

mm 

Y-component of accelerometer trend 

29 


Z-component of accelerometer trend 













































Table A.3. Definition of INS Truth Model Subvector 6 x 3 


State 

Number 


30 


31 


32 


33 


34 


35 


36 


37 


38 


39 


40 

41' 


42 


43 


44 


45 


46 


47 


State 

Symbol 


b. 


is* 


J 9v 




Xi 


X2 


X3 


V\ 


Vi 


V3 


D x 


D 


MV 


D t 




Sqby 


S Qt>. 


Definition 


X-component of gyro dr ift rate repeatability 

Y-component of gyro drift rate repeatability 

7 rrzrrrrii _ urn. _*__ 
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Z-component of gyro drift rate repeatability 
X-component of gyro scale factor error 


Y-component of gyro scale factor error 


Z-component of gyro scale factor error 


X gyro misalignment about Y-axis 


Y gyro misalignment about X-axis 


Z gyro misalignment about X-axis 


X gyro misalignment about Z-axis 


Y gyro misalignment about Z-axis 


Z gyro misalignment about Y-axis 


X gyro scale factor non-linearity 


Y gyro scale factor non-linearity 


Z gyro scale factor non-linearity 


X gyro scale factor asymmetry error 


Y gyro scale factor asymmetry error 

m to. 


Z gyro scale factor asymmetry error 
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Table A.4. Definition of INS Truth Model Subvector Sx 4 


State 

Number 

mmm 

Definition 

48 

sa 

X-component of accelerometer bias repeatability 

49 

Y-component of accelerometer bias repeatability 

50 


Z-component of accelerometer bias repeatability 

51 


X-component of accelerometer and velocity 
quantizer scale factor error 

52 


Y-component of accelerometer and velocity 
quantizer scale factor error 

53 


Z-component of accelerometer and velocity 
quantizer scale factor error 

54 

Sqa x 

X-component of accelerometer and velocty 
quantizer scale factor asymmetry 

55 

Sqa v 

Y-component of accelerometer and velocty 
quantizer scale factor asymmetry 

56 

Sqa, 

Z-component of accelerometer and velocty 
quantizer scale factor asymmetry 

57 

fxx 

Coefficient of error proportional to square 
of measured acceleration 

58 

fvv 

Coefficient of error proportional to square 
of measured acceleration 

59 

u 

Coefficient of error proportional to square 
of measured acceleration 

60 

fxy 

Coefficient of error proportional to products of accel¬ 
eration along and orthogonal to acceleromter sensitive axis 

61 

fx. 

Coefficient of error proportional to products of accel¬ 
eration along and orthogonal to acceleromter sensitive axis 

62 

fyx 

Coefficient of error proportional to products of accel¬ 
eration along and orthogonal to acceleromter sensitive axis 

63 

wm 

Coefficient of error proportional to products of accel¬ 
eration along and orthogonal to acceleromter sensitive axis 

64 

WM 

Coefficient of error proportional to products of accel¬ 
eration along and orthogonal to acceleromter sensitive axis 

65 

f*V 

Coefficient of error proportional to products of accel¬ 
eration along and orthogonal to acceleromter sensitive axis 

66 

Hi 

X accelerometer misalignment about Z-axis 

67 

Hi 

Y accelerometer misalignment about Z-axis 

68 

H3 

Z accelerometer misalignment about Y-axis 


*3 

Z-accelerometer misalignment about X-axis 



































































Table A.6. Definition of INS Truth Model Subvector 6 x« 


KS3I 

State 

Symbol 

Definition 

76 

mmm 

X gyro compliance term 

77 

mum 

X gyro compliance term 

78 

wiem 

X gyro compliance term 

79 

Knu 

X gyro compliance term 

80 

wtmm 

X gyro compliance term 

81 


X gyro compliance term 

82 

mmm 

Y gyro compliance term 

83 

warn 

Y gyro compliance term 

84 


Y gyro compliance term 

85 

mmm 

Y gyro compliance term 

86 

mam 

Y gyro compliance term 

87 

mom 

Y gyro compliance term 

88 

HLffl 

Z gyro compliance term 

89 

mam 

Z gyro compliance term 

90 

F,„ | 

Z gyro compliance term 

91 

WBSS 

Z gyro compliance term 

92 

KOI 

Z gyro compliance term 

93 

Z gyro compliance term 
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Appendix B. Initial INS Covariance Matrix Values 

The covariance matrix prior to alignment is a diagonal matrix where the diag¬ 
onal terms are the variances of the states. The off-diagonal terms are the covariances 
between states. Since the covariance terms are all zero, they are not provided in the 
following tables. The variances are broken into six tables, one table for each state 
subvector. 


Table B.l. Initial Variances for Subvector <5xi 


State 

1 a Value for 
Static Navigation 

1<7 Value for 
Fighter Flight 

1 

0 rad 

0 rad 

2 

0 rad 

0 rad 

3 

0 rad 

0 rad 

4 

1800 sec 

1800 sec 

5 

1800 sec 

1800 sec 

6 

1800 sec 

1800 sec 

7 

0 fps 

0 fps 

8 

0 fps 

0 fps 

9 

0 fps 

0 fps 

10 

0 ft 

Oft 

11 

0 ft 

Oft 

12 

0 ft 

Oft 

13 

0 fps* 

0 fps* 
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Table B.2. Initial Variances for Subvector 6 x 2 


State 

1<7 Value for 
Static Navigation 

1<7 Value for 
Fighter Flight 

14 

0 °/hr. 

0 .002°/hr. 

15 

0 °/hr. 

0 .002°/hr. 

16 

0 °/hr. 

0 .002°/hr. 

17 

2 /*g 

2 

18 

2 /ig 

2 A*g 

19 

2 Hg 

2 ^g 

20 

0 sec 

5 sec 

21 

0 sec 

5 s'ec 

22 

0 sec 

0 s'ec 

23 

0 ft. 

100 ft. 

24 

0 .000r/hr./hr. 


25 

0 .0001 o /h r ./hr. 

0 .0001°/hr./hr. 

26 


0 .0001°/hr./hr. 

27 

1 ng/hv. 

■nm 

28 

■am 

1 ng/hr. 

29 

mmmmm 

1 A*g/hr. 
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Table B.3. Initial Variances for Subvector Sx 3 


State 

l<r Value for 
Static Navigation 

1 a Value for 
Fighter Flight 

30 

0.003°/hr. 

0.003°/hr. 

31 

0.003°/hr. 

0.003°/hr. 

32 

0.003°/hr. 

0.003°/hr. 

33 

0.0005% 

0.0005% 

34 

0.0005% 

0.0005% 

35 

0.0005% 

0.0005% 

36 

1.5 sec 

1.5 sec 

37 

1.5 sec 

1.5 sec 

38 

0 sec 

1.5 sec 

39 

0 sec 

1.5 sec 

40 

1.5 sec 

1.5 sec 

41 

1.5 s'ec 

1.5 sec 

IK9 



43 

0 (°/hr.)/(rad/sec .) 2 

0.5(°/hr.)/(rad/sec .) 2 

44 

0.5(°/hr.)/(rad/sec .) 2 

0.5(°/hr.)/(rad/sec.) i 

45 

1 ppm 

1 ppm 

46 

0 ppm 

1 ppm 

47 

1 ppm 

1 ppm 
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Table B.5. Initial Variances for Subvector 6 xs 


State 

1<7 Value for 
Static Navigation 

la Value for 
Fighter Flight 

70 

6 pg 

6 /<g 

71 

6 /ig 

6 /*g 

72 

0 /ig 

6 ^g 

73 


0.003°/hr. 

74 

■KBBSHi 


75 

■nai 

K&Z3fli3Bl 
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Table B.6. Initial Variances for Subvector Sxq 


State 

1 a Value for 

1<t Value for 


Static Navigation 

Fighter Flight 

76 

0 sec/g 

0.3 sec/g 

77 

0 sec/g 

0.3 sec/g 

78 

0 sec/g 

0.3 sec/g 

79 

0 sec/g 

0.3 sec/g 

80 

0.3 sec/g 

0.3 sec/g 

81 

0.3 sec/g 

0.3 sec/g 

82 

0.3 sec/g 

0.3 sec/g 

83 

0.3 sec/g 

0.3 sec/g 

84 

0 sec/g 

0.3 sec/g 

85 

0 sec/g 

0.3 sec/g 

86 

0 sec/g 

0.3 sec/g 

87 

0 sec/g 


88 


0.3 sec/g 

89 


0.3 3ec/g 

K9 

0 sec/g 

— flKgrgW 

91 

0 sec/g 

0.3 sec/g 

92 

0 sec/g 

0.3 sec/g 

93 

0 sec/g 
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Appendix C. Elements of the INS Truth Model Dynamics Matrix 

The INS truth model dynamics matrix is a 93 by 93 matrix. This matrix is 
broken into submatrices which are defined in the text. The non-zero elements of the 
submatrices are shown here. Each element is referred to by its place in the overall 
dynamics matrix, not by its position in the submatrix. The elements of the C£, 
sensor-to-true, matrix are used here as Cy where i is the row and j is the column in 
the transformation matrix. 
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Table C.l. Elements of the Dynamics Submatrix Fn 
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Table C.2. Elements of the Dynamics Submatrix F 12 



Element Term Element Term Element Term 




mwm. 

C\2 

mam 


C\\t 

mmm 

C\ it 

(8,17) 

C 21 

(8,18) 

C 22 

( 8 , 21 ) 

1 

■csaa 

Cut 

(8,29) 

C 23 t 

(9,17) 

Cz\ 

HBEHI 

C 33 

(9,22) 

1 


C31< 

!■(*£)■ 

Czit 


mm 




Table C.3. Elements of the Dynamics Submatrix F 13 


Element I Term II Element | Term || Element | Term 


(4,30) 


(4,33) 



(4,45) 


(5,30) 




0.5Cn|t^ t 



(5,39) 

— 

CnUib 

(5,42) 

Czi^ib, 


0.5Cai 


C31 


MB 



5C3i Iw.f,, | 


(4,31) 


(4,34) 


(4,37) 


(4,40) 


(4,43) 


(4,46) 


(5,31) 


(5,46) 


(6,31) 



C 


C\ 2^ib 


0.5Cn 


C 22 


-C 


C 2 


CnUib. 


O. 5 C 22 


C 32 


(6,40) 


(6,43) 


(6,46) | 0.5C32|u?rt 



(4,41) 


(4,44) 


(4,47) 


(6,35) 


(6,38) 


(6,41) 


(6,44) 


Cl3 U)^ 


Q.5Cj3 


C 23 



CttVib 


-C 33u> ib 




0.5C33|u;rt,| 















































































































































Table C.4. Elements of the Dynamics Submatrix F 14 


Element Term 


C\\ 


(7,51) 


Cu A 


(7,57) 




Element 





(9,67) 


(7,52) 


(7,58) 


(7,61) 


(7,64) 


(8,51) 


(8,54) 


(8,57) 


(8,60) 


( 8 , 66 ) 


(9,53) 


(9,56) 


(9,59) 


(9,62) 


(9,65) 


(9,68) 


Term 


C 


C 


Cn\A°\ 


C 


—C\iA 


Ci 1 


Cn\A* | 


CnAgAf 


C 22 A?A 


C23A 


C 33 


Element I Term 


(7,50) C 13 


(7,53) | C 13 A 


(7,56) 


(7,59) 


(7,62) 


(7,65) 


(7,68) C 13 A 


(8,49) 


(8,52) 


(8,55) 


(8,58) 


(8,61) 


(8,64) \C 23 A?A 


(8,67) -C 22 A 


(9,48) | C 31 


(9,54) 


(9,57) 


(9,60) 


(9,63) 


(9,66) 


(9,69) 




C33A 


Table C.5. Elements of the Dynamics Submatrix F 15 







































































































































Table C.6. Elements of the Dynamics Submatrix Fia 


Element 


M 


4,79) 


582) 


4,85) 


4,88 

m 


M 


(V9) 


(5,82) 


T585y 


(5,88) 


(5,91) 


(6,76) 


(6,79) 


(6,85) 


( 6 , 88 ) 


(6,91) 


Term 


CnA^Ujb, 


CnAfuib 




CuAfuib, 

CuAgUib, 


CuA*Uib % 


C l3 A*u>ib, 


C n A* 

~n~\B 


W<6, 


C 2 iAfu ibtl 

CnAfuib] 


C 22 AgUiib, 

C 23 A g ujh 




C 23 AyUJib, 

T&7 


C 3 \A g Uj bt 


C31 A^uijb v 


C 32 A^Uj b, 


C 32 A g Uib, 


& 


CssAgUibi 

r» aB,.,. 


^33 b a 


Element 


(4,77) 


(4,80) 


(4,83) 


(4,86) 


4,89) 


4,92) 


1M 

1W 


(5,83) 


(5,86) 


(5,89) 


(5,92) 


(6,77) 


(6,80) 


(6,83) 


( 6 , 86 ) 

(6,89) 


(6,92) 


Term 


CnA%oj ibu 

\*r 


CnAfuib . 

to, 


CnAfuib, 


C\ 2 A X ujjb. 


CxzAgWjb, 

C\ 3 Afuib y 


Hr 

CnAfuib 


CnAfuib. 

CnA*Uib, 


^-'2'jA x LJib x 

CwAgUib. 


C23 utib, 


C 31 Azuib, 

ft 


C 3 \Afu>jb, 

CsjA^Ujb, 


CwAgUJ ib, 


C&A*Wjh a 

CttAylOiby 


Element 


(4,78) 


(4,81) 


(4,84) 


(4,87) 


(4,90) 


(4,93) 


(5,78) 


(5,81) 


(5,84) 


(5,87) 


(5,90) 


(5,93) 


(6,78) 


(6,81) 


(6,84) 


(6,87) 


(6,90) 


(6,93) 


Term 


C 11 A^ (Jjb^ 

I B, 


CnAfujbg 


CnA^Ujby 


CijA gUib^ 


C\ 3 A%tx>ib, 


C lz A*Uib t 


C 2 \A~u>i bx 
nsr 


Cn A x u>jb z 


Cji AjUib^ 


Cjl Ag U>jb u 


C23 A^liJib, 
C23 Ay U>ib, 


C 3l A*u ibx 

B, 


C 3 iAju>ib x 


C 32 A x u>iby 
C32 A t Ufjby 


CnAfuib, 

^33 AyU)jb X 


Table C.7. Elements of the Dynamics Submatrix F22 


Element 

Term 

Element 

Term 

Element 

Term 

(14,14) 

mm 


-Ac_ 

(16,16) 

mm 

(17,17) 

mm 

■ibbm 

mm 

ITtiJIUll 

mm\ 

(20,20) 

mm 

(21,21) 

mm 

mmvm 

mm 

iHgmi 

-06h e 



wmM 

■HI 


Table C.8. Elements of the Dynamics Submatrix F55 


Element 

Term 

Element 

Term 

Element 

Term | 

(70,70) 

~fa" 

(71,71) 

mm 

mmsm 

Ban 

(73,73) 

mm 


mm 

(75,75) 
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Appendix D. Elements of the Process Noise Matrix 

The process noise matrix contains mostly zeros. The matrix was subdivided 
into two submatrices which contain the non-zero elements and a number of zero 
matrices. Only the non-zero elements of the submatrices are shown here. The 
elements are referred to by their placement in the overall matrix, not their placement 
in the submatrices. 

Table D.l. Non-zero Elements of Process Noise Submatrix Qn 


Element 

Term 

Element 

Term 

(4,4) 

< 

(5,5) 


(6,6) 


(7,7) 

< 

(8,8) 


(9,9) 

< 


Table D.2. Non-zero Elements of Process Noise Submatrix Q22 


| Element 

Term 

Element 

Term 

(14,14) 

WBSM 

WBEEM 

J 

■tEHM 

WBBM 

(17,IT) 

EjBEm 

(18,18) 

M 

(18,18) 

KsfllbMIl 

(20,20) 

Mh.'L 

(21,21) 


(22,22) 

mmm 

(23,23) 

mmm\ 


D-l 






























Appendix E. Instrumentation Port Block 1022 Definition File 


The block definition file for block 1022 from the GPS receiver’s instrumentation 
port is shown below. Explanations of each column may be found in Chapter 5. The 
block definition file is necessary for post processing interpretation of data collected 
with PC Buffer Box. 


BDF BLOCK 1022 FILTER OBSERVATION BLOCK 


TIME 

1022 

1 

4 

R 

MEAS_TIME_TAG 

1022 

5 

3 

CF 

MEAS.COUNT 

1022 

8 

1 

I 

MEAS_TYPE_1 

1022 

9 

1 

I 

MEAS.TYPE.2 

1022 

10 

1 

I 

MEAS.TYPE.3 

1022 

11 

1 

I 

MEAS_TYPE_4 

1022 

12 

1 

I 

MEAS_TYPE_5 

1022 

13 

1 

I 

MEASJ1'YPE_6 

1022 

14 

1 

I 

MEAS.TYPE_7 

1022 

15 

1 

I 

MEAS.TYPE.8 

1022 

16 

1 

I 

MEASJTYPE_9 

1022 

17 

1 

I 

MEAS_TYPE_10 

1022 

18 

1 

I 

MEAS.TYPE.ll 

1022 

19 

1 

I 

PSEUDO.RNG.l 

1022 

20 

3 

CF 

PSEUDO.RNG.2 

1022 

23 

3 

CF 
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PSEUD0_RNG_3 

1022 

26 

3 

CF 

PSEUD0.RNG.4 

1022 

29 

3 

CF 

PSEUD0.RNG.5 

1022 

32 

3 

CF 

DELTA.RNG.l 

1022 

35 

2 

CF 

DELTA.RNG.2 

1022 

37 

2 

CF 

DELTA_RNG_3 

1022 

39 

2 

CF 

DELTA_RNG_4 

1022 

41 

2 

CF 

DELTA_RNG_5 

1022 

43 

2 

CF 

ALTITUDE_MEAS 

1022 

45 

2 

CF 

PRED JPSU_RN G_1 

1022 

47 

3 

CF 

PRED_PSU_RNG_2 

1022 

50 

3 

CF 

PRED_PSU_RN G_3 

1022 

53 

3 

CF 

PRED_PSU_RN G_4 

1022 

56 

3 

CF 

PRED_PSU_RNG_5 

1022 

59 

3 

CF 

PRED_DEL_RNG_1 

1022 

62 

2 

CF 

PR ED_DEL_RN G_2 

1022 

64 

2 

CF 

PRED.DEL.RNG.3 

1022 

66 

2 

CF 

PREDJ>EL_RNG_4 

1022 

68 

2 

CF 

PRED_DEL_RN G_5 

1022 

70 

2 

CF 

PRED JDELJRN G_6 

1022 

72 

2 

CF 

SV.ID.l 

1022 

74 

1 

I 

SV_ID_2 

1022 

75 

1 

I 

SV.ID.3 

1022 

76 

1 

I 

SVJD.4 

1022 

77 

1 

I 

SV_ID_5 

1022 

78 

1 

I 

SV.ID.6 

1022 

79 

1 

I 

SV_ID_7 

1022 

80 

1 

I 

SV.ID.8 

1022 

81 

1 

I 
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SVJD.9 

1022 

82 

1 

I 

SVJD.10 

1022 

83 

1 

I 

SVJD.11 

1022 

84 

1 

I 

CHAN_ID_1 

1022 

85 

1 

I 

CHAN_ID_2 

1022 

86 

1 

I 

CHANJD.3 

1022 

87 

1 

I 

CHAN.ID.4 

1022 

88 

1 

I 

CHAN_ID_5 

1022 

89 

1 

I 

CHAN_ID_6 

1022 

90 

1 

I 

CHAN_ID_7 

1022 

91 

1 

I 

CHAN_ID_8 

1022 

92 

1 

I 

CHANJD.9 

1022 

93 

1 

I 

CHAN_ID_10 

1022 

94 

1 

I 

CHAN.ID.U 

1022 

95 

1 

I 
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Appendix F. Errata for LN-93 INS Truth Model 

The document containing the truth model for the LN-94 contains a number of 
discrepancies and omissions. This is a list of the errors discovered in the document 
listed by page and section if multiple sections are on a single page. 

page 6 

"A*." Should be "fo hc " 

" Pb,* — 1/10 per min., not the 5 min. correlation time that is shown. 

= 1/5 per min., not the 10 min. correlation time that is shown. 

"f3b, ” = 1/600 per sec., not the 60 sec. correlation time that is shown. 

page 7 
Section 3.1 

"69, m " should be "69 x = ” 

”66 y = ” should be "60 y = ” 

”66 x = ” should be "69, = ” 

Section 3.2 

"4> x — " should be = " 

in the <j> s equation, should be "u>,<f> y " 

"<j>y = ” should be "<j> y — " 

"<t>, = ” should be "<t>, = ” 
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Section 3.3 


” 6 V X = " should be ”6V X = ” 

” 6 V v = " should be ” 6 V y = ” 

page 8 

To make the equations reflect the fact that Litton used Shg = 6 h c 

in the 6 V X equation, ”A:2<5 /i,b’’ should be r ’k 2 Sh e r> 
in the 6 h equation, "kiSha" should be ”k\ 6 h c ” 

in the 6 S 3 equation, ” — k^Shs” should be ” — k 3 fih c " 

• • 
in the 6 S 4 equation, ” — k^Shs” should be ” — k\ 6 h c ” 

= 5h c 
Also, 

in the 6 S 4 equation, "k^Shi? should be "k^Shi' 
page 9 

in the Crx equation, ” — 2Cy v ” should be ” — 2 C Yx " 
n Cxm = ” should be ” C x , = ” 

"C Xv = ” should be *C Xy = ” 

” Cxm — ” should be "C*, = ” 

*C Yx = ” should be n C Yx = ” 

”C Yy = " should be n C Yy = ” 

”Cy, = " should be ”C Yt = ” 
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page 10 


Cx,( 0 ) = SA(0)C*(0) 

page 18 

" = (6^)C‘ /60 sec” should be " = (6^)e‘/«°sec” 
page 21 

8 S 4 — (Jfc 4 — 1 )£S 4 + fc 4 6Aj, - fc 4 $/i c . Omit rest of line, 
page 22 

element (6,2), should be "Cm” 
page 23 

element (5,12), ” — C 2 3^x n 
page 24 

element (7,6), n C\^A'” 
element (8,6), "CisA'” 
element (8,12), "CnA?" 
element (9,12), "CmA?” 
element (7,19), ”CuA y ” 
element (8,19), "CjiAy” 
element (9,19), ”C3iA v ” 
element (7,20), ” — C' 12 /U r 
element (8,20), ” — C33A*” 
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element (9,20), n — C 3i A x n 
page 26 

heading of column 10 should be 
heading of column 11 should be ” F Vtx n 
element (4,11), ”Ci 2 A x u> c ” 
element (5,11), r 'C-iiA x u s r ‘ 
element (6,11), ' n C 3 2 A x uj x ” 

page 36 

gyro compliance errors are in arcseconds/g not seconds/g 
Other errors and discrepancies: 

It is never stated that a$h c — 100 ft. for the simulation. 

The following are some notes about items which may escape attention in the 
truth model document because of their placement in the text. 

Notes: 

w’s and v4’s in the e and V equations, on pages 14 and 17 respectively, are 
referenced in the body frame. 

Different sets of initial errors and driving noises are used for different navigation 
simulations. 

Only four of the six accelerometer misalignment errors are used in the truth 
model. 
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Appendix G. Litton Error Plots for Static Navigation and Flight 


The error plots provided by Litton for comparison of navigation simulations 
are presented here. The errors for the static navigation case are presented in the 
first two figures, followed by the errors for the fighter flight profile. 
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Figure G.3. Litton Fighter Flight Errors 


1101 I Of O f 












Figure G.4. Fighter Flight Errors 
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